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1.  PURPOSE 


The  purpose  of  this  document  is  to  specify  the  equations 
necessary  to  perform  the  guidance,  navigation  and  control  onboard 
computation  functions  for  the  space  shuttle  orbiter  vehicle.  This 
equations  document  will  provide  as  comprehensive  a set  of  equations 
as  possible  from  which  modules  may  be  chosen  to  develop  Part  I 
Specifications  for  particular  vehicles,  computers  and  missions. 

This  document  is  expected  to  be  the  source  of  any  equations  used 
to  develop  software  for  hardware/software  feasibility  testing,  for 
ground-based  simulations  or  flight  test  demonstrations. 
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2.  SCOPE 


This  document  defines  a baseline  set  of  equations  which 
fulfill  the  computation  requirements  for  guidance,  navigation  . 
and  control  of  the  space  shuttle  or biter  vehicle.  All  shuttle 
mission  phases  are  covered  from  Prelaunch  through  Landing/Rollout. 
The  spacecraft  flight  mode  and  the  aircraft  flight  mode  are  ad- 
dressed. Equations  are  included  for  the  Mark  I systems  and  Mark  II 
systems  through  the  all-up  shuttle  configuation.  Control  of  the 
booster  during  launch  is  covered.  The  baseline  equations  may  be 
implemented  in  a single  GN&C  computer  or  may  be  distributed  among 
several  subsystem  computers,  depending  upon  the  outcome  of  cen- 
tralization/decentralization deliberations  currently  in  progress. 
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3.  APPLICABILITY 


This  document  is  applicable  to  the  guidance,  navigation  and 
control  (GNScC)  computation  functions  for  the  space  shuttle  orbiter 
vehicle.  It  specifies  a set  of  baseline  design  equations  which 
may  be  used  for  the  shuttle  program  software  specification  and 
hardware,  sizing.  It  defines  the  baseline  equations  for  MSC.G&CD 
hardware/sof tware  simulation. 
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preceding  page  blank  not  filmed 

FOREWORD 


This  second  publication  of  the  Space  Shuttle  GN&C  Design  Equation  Document 
contains  baseline  equations  for  approximately  fifty  percent  of  the  GN&C 
computation  requirements  as  specified  in  the  GN&C  S/W  Functional  Requirements 
Document  (MSC-03690  Rem.  B) . This  document  supercedes  the  original  2430-04217 
and  the  subsequently  published  revision.  Additions  or  corrections  to  this 
document  since  its  original  publication  are  indicated  in  the  Table  of  Contents 
by  asterislcs  in  the  margin. 

It  is  planned  to  republish  this  document  in  a new  revision  in  approximately 
four  months  time.  At  that  time  it  is  anticipated  that  equations  will  be 
available  for  virtually  all  requirements.  The  new  revision  will  be  issued 
with  format  changes  intended  to  stress  interdependency  of  related  submittals 
and  to  eliminate  duplication  to  the  greatest  degree  practicable. 

This  issue  has  been  modified  to  reflect  the  shuttle-structure  and  avionics- 
configuration  changes  which  have  occurred  subsequent  to  the  first  issue.  A 
significant  change  is  that  orbiter  control  of  the  booster  has  been  added  as 
a requirement.  Decentralization  of  the  computations  and  Allocation  to  sub- 
systems is  the  current  trend  with  the  MARK  I & MARK  II  shuttle  configurations. 

The  computation  requirements  for  shuttle  vehicles  and  missions  may  be  much  less 
than  those  allowed  for  in  this  document.  However,  since  the  configurations  are 
very  fluid  at  this  state  in  the  shuttle  development,  the  approach  adopted  in 
this  document  is  to  include  as  complete  a set  of  design  equations  as  possible 
to  cover  reasonable  possibilities.  Therefore,  subsets  of  equations  may  be  ex- 
tracted from  this  document  to  form  specifications  for  specific  vehicles,  com- 
puters and  missions. 

The  GN&C  Design  Equations  document  is  the  result  of  the  efforts  of  many  people 
from  NASA  and  support  contractors.  The  list  is  too  long  to  credit  all  con- 
tributors; however,  contractors  which  made  direct  contributions  to  the  document 
are  as  follows: 

a.  TRW  Systems  Group,  Inc.,  Houston  Operations 

b.  MIT/Charles  Stark  Draper  Laboratory 

c.  Lockheed  Electronics  Co.,  Inc.,  Houston  Aerospace  Systems  Division 

d.  The  Boeing  Co.,  Houston,  Texas 

The  equations  are  reviewed  by  the  GN&C  Formulation  and  Implementation  Panel 
and  their  comments  included  on  submittal  forms  where  appropriate.  The  names 
of  equation  submitters  are  included  on  the  submittal  sheet  in  each  section. 
Comments  on  the  submittals  should  be  referred  to  the  individual  submitter  or 
to  the  responsible  NASA  engineer.  General  comments  on  the  document  or  proposed 
submittals  should  be  referred  to  the  System  Analysis  Branch,  Guidance  and  Control 
Division. 
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9.  DESCRIPTIONS  OF  EQUATIONS 

The  detailed  equations  for  the  GN&C  functions  are  defined  in  this 
section.  The  organization  of  this  section  is  tentative  and  will  be 
modified  so  as  to  present  the  equations  as  they  are  designed  in  as  clear 
a fashion  as  possible.  As  an  introduction  to  each  major  subsection 
(usually  a mission  phase) , the  general  GN&C  software  functions  to  be 
implemented  will  be  identified  and,  where  appropriate,  a conceptual 
discussion  and  top  level  flow  of  the  computations , inputs  and  outputs 
will  be  included  in  order  to  understand  and  summarize  what  is  to  be 
covered.  This  should  be  an  order  of  magnitude  less  detailed  than  the 
flow  diagrams  of  the  equations  which  come  later. 

A GN&C  Equation  Submittal  sheet  will  introduce  each  of  the  GN&C 
equation  submittals  and  summarize  the  GN&C  functions,  and  identify  the 
source  and  NASA  contact  for  each. 

The  detailed  data  to  be  presented  for  each  GN&C  function  within  each 
of  the  major  subsections  (usually  a mission  phase)  is  summarized  below. 
Although  items  6 through  10  are  to  be  referenced  only  in  the  equations 
document , they  are  required  submittals  before  the  equations  can  be 
approved  and  finalized  for  flight  software  development. 

1.  Functional  Requirements 

The  specific  functional  requirements  (from  the  GN&C 
Software  Functional  Requirements  Document)  which  are 
satisfied  by  the  equations  should  be  identified. 

2 . Functional  Diagram 

A brief  functional  explanation  and  description  of  the 
overall  concept  and  approach.  A functional  block 
diagram  should  be  used  where  clarity  is  enhanced. 

Inputs,  outputs,  and  interfaces  will  be  provided. 

3 . Equations  and  Flows 

Detailed  equations  and  a descriptive  text  which  guides 
the  reader  through  the  flows  of  Section  10  should  be 
provided.  The  minimum  frequency  of  the  computations 
shall  be  specified  and  rationale  given  or  referenced. 
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4 . Coordinate  System 

The  coordinate  systems  used  shall  be  defined. 

5 . Constants /Variables  Summary 

Constants  and  variables  shall  be  summarized  in  tabular 
form  with  the  following  information: 

a.  Variables /constants  symbols  and  definitions 

b.  Units 

c.  Allowable  quantization 

d.  Range  of  values 

6.  FORTRAN  Coding 

The  FORTRAN  coding  of  the  function  for  verification  using 
the  Space  Shuttle  Flight  Simulation  (SSFS)  will  be 
referenced. 

7 . Simulation 

The  SSFS  specifications,  description  and  user's  guide 
used  to  verify  each  GN&C  function  will  be  referenced. 

8.  Testing 

Test  plans  and  test  results  will  be  referenced. 

9 . Derivation 

The  mathematical  derivation  of  the  equations  including 
all  mathematical  assumptions  shall  be  referenced. 

10 .  Assumptions 

The  following  will  be  referenced: 

a.  Avionics  baseline  system  assumed 

b.  Reference  missions  assumed 

c.  Vehicle  mass  properties  assumed 

d.  Propulsion  models  assumed 

e.  Environment  models  assumed 

f.  Error  models  assumed 

The  major  subsections  of  this  section  are  identified  and  partially 
expanded  in  the  following. 
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9.6  ORBITAL  COAST 


The  following  GN&C  software  functions  are  envisioned  for  the  orbital 
coast  phase: 

Sensor  Alignment  and  Calibration 

1.  Perform  automatic  calibration  of  sensors  and  compute 
compensation  values  during  coasting  orbital  flight. 

2.  Perform  automatic  sensor  pointing  and  alignment  during 
coasting  orbital  flight. 

Orbit  Navigation 


3.  Advance  inertial  vector  with  conic  solutions  from  an 
initial  state  to  a final  state  as  a function  of  time 
or  anomaly. 

4.  Augment  conic  state  advancement  with  numerical 
integration  to  account  for  complex  gravity  potential 
models . 

5.  Reduce  uncertainties  in  inertial  state  by  accepting 
and  processing  data  from  navigation  sensors  (ground 
beacons,  radar  altimeter). 

Attitude  Control 


6.  Maintain  attitude-hold  about  a desired  orientation. 

7.  Provide  attitude  rate-hold  about  a desired  rate  for 
orbital  rate  control,  station  keeping,  passive  thermal 
control  or  other  constant-rate  maneuvers. 

8.  Provide  semi-automatic  control  by  initializing  attitude 
hold  following  manual  maneuvers. 

9.  Implement  minimum-impulse  jet  firings  when  required 

by  the  autopilot  or  selected  by  the  crew  for  manual  control. 

10.  Maintain  attitude  for  target  visibility  at  crew  and  radar 
locations  during  the  coast  periods  of  rendezvous,  station 
keeping  and  docking  approach. 

9.6.1  Orbital  Navigation 
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SPACE  SHUTTLE 


GN&C  SOFTWARE  EQUATION  SUBMITTAL 

Software  Equation  Section:  Conic  State  Extrapolation  Submittal  No.  6 

Function:  Advance  inertial  state  with  conic  solutions 

Module  No.  0N2  Function  No.  1 (MSC  03690) 

Submitted  by:  W.  M.  Robertson  Co.  MIT  No.  3-71 

Date : Feb  1971 

NASA  Contact:  J.  Suddath  Organization:  GCD 

Approved  by  Panel  III:  K.  Cox  K.  T Date:  ~^//rV 7 / 

Summary  Description:  Provides  the  capability  to  advance  a geocentric 

inertial  state  as  a function  of  time  or  true  anomaly.  The  extrapolation 
is  done  analytically  assuming  Keplerian  motion. 

Shuttle  Configuration:  These  equations  are  independent  of  Shuttle 

configuration. 

Comments : 

(Design  Status)  

(Verification  Status)  

Panel  Comments : 
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9. 6. 1.1  Conic  State  Extrapolation 


i.  INTRODUCTION 

The  Conic  State  Extrapolation  Routine  provides  the  capabil- 
ity to  conically  extrapolate  any  spacecraft  inertial  state  vector  either 
backwards  or  forwards  as  a function  of  time  or  as  a function  of 
transfer  angle.  It  is  merely  the  coded  form  of  two  versions  of  the 
analytic  solution  of  the  two -body  differential  equations  of  motion  of 
the  spacecraft  center  of  mass.  Because  of  its  relatively  fast  compu- 
tation speed  and  moderate  accuracy,  it  serves  as  a preliminary 
navigation  tool  and  as  a method  of  obtaining  quick  solutions  for  tar- 
geting and  guidance  functions.  More  accurate  (but  slower)  results 
are  provided  by  the  Precision  State  Extrapolation  Routine. 
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9. 6. 1.1  Conic  State  Extrapolation  (continued) 
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9. 6. 1.1'  Conic  State  Extrapolation  (continued) 
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9. 6. 1.1  Conic  State  Extrapolation  (continued) 
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Coefficients  of  power  series  inversion  of  Universal 
Kepler  Equation 
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9. 6. 1.1'  Conic  State  Extrapolation  (continued) 


2.  FUNCTIONAL  FLOW  DIAGRAM 

The  Conic  State  Extrapolation  Routine  basically  consists  of 
two  parts  — one  for  extrapolating  in  time  and  one  for  extrapolating  in 
transfer  angle.  Several  portions  of  the  formulation  are,  however, 
common  to  the  two  parts,  and  may  be  arranged  as  subroutines  on  a . 
computer. 

2.  1 Conic  State  Extrapolation  As  A Function  Of  Time  (Kepler 

Routine) 

This  routine  involves  a single  loop  iterative  procedure,  and 
hence  is  organized  in  three  sections:  initialization,  iteration,  and 
final  computations,  as  shown  in  Fig.  1.  The  variable  "x"  is  the  in- 
dependent variable  in  the  iteration  procedure.  For  a given  initial 
state,  the  variable  "x"  measures  the  amount  of  transfer  along  the  ex- 
trapolated trajectory.  The  transfer  time  interval  and  the  extrapolated 
state  vector  are  very  conveniently  expressed  in  terms  of  "x".  In  the 
iteration  procedure,  "x"  is  adjusted  until  the  transfer  time  interval 
calculated  from  it  agrees  with  the  specified  transfer  time  interval 
(to  within  a certain  tolerance).  Then  the  extrapolated  state  vector 
is  calculated  from  this  particular  value  of  "x". 

2.2  Conic  State  Extrapolation  As  A Function  Of  Transfer  Angle 

( Theta  Routine ) 

This  routine  makes  a direct  calculation  ( i.  e.  does  not  have 
an  iteration  scheme ),  as  shown  in  Fig.  2.  Again,  the  extrapolated 
state  vector  is  calculated  from  the  parameter  "x".  The  value  of  "x" 
however,  is  obtained  from  a direct  computation  in  terms  of  the  conic 
parameters  and  the  transfer  angle  9.  It  is  not  necessary  to  iterate 
to  determine  "x",  as  was  the  case  in  the  Kepler  Routine. 
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9. 6.1.1  Conic  State  Extrapolation  (continued) 


Figure  1 KEPLER  ROUTINE  FUNCTIONAL  FLOW  DIAGRAM 
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9. 6. 1.1  Conic  State  Extrapolation  (continued) 


Figure  2 THETA  ROUTINE  FUNCTIONAL  FLOW  DIAGRAM 
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9. 6. 1.1  Conic  State  Extrapolation  (continued) 


3.  ROUTINE  INPUT-OUTPUT 

The  Conic  State  Extrapolation  Routine  has  only  one  system 
parameter  input:  the  gravitational  parameter  of  the  earth.  Its  prin- 
cipal real-time  inputs  are  the  inertial  state  vector  which  is  to  be  ex- 
trapolated and  the  transfer  time  interval  or  transfer  angle  through 
which  the  extrapolation  is  to  be  made.  Several  optional  secondary 
inputs  may  be  supplied  in  the  transfer  time  case  in  order  to  speed 
the  computation.  The  principal  real-time  output  of  both  cases  is  the 
extrapolated  inertial  state  vector. 

3.  i Conic  State  Extrapolation  As  Function  of  Transfer  Time 

Interval  (Kepler  Routine) 


Input  Parameters 


System 


Pg  : Gravitational  parameter  of  the  earth  ( Product  of 

earth's  mass  and  universal  gravitational  constant). 

Real-Time  (Required) 

(Cq.  Vq)  : Inertial  state  vector  which  is  to  be  extrapolated 

(corresponds  to  time  t^). 

(t  - t^)  : Transfer  time  interval  through  which  the  extrapola- 

tion is  to  be  made. 

Real-Time  (Optional ) 


x : Guess  of  independent  variable  corresponding  to  solu- 

tion in  Kepler  iteration  scheme.  (Used  to  speed  con- 
vergence ) . 
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9. 6. 1.1'  Conic  State  Extrapolation  (continued) 

^ t ” t0  >c  : Value  of  dependent  variable  (the  transfer  time  inter- 

val) in  the  Kepler  iteration  scheme,  which  was 
calculated  in  the  last  iteration  of  the  previous  call  to 
Kepler. 

x1  • Value  of  the  independent  variable  in  the  Kepler  itera- 

c 

tion  scheme,  to  which  the  last  iteration  of  the 
previous  call  to  Kepler  had  converged. 

Output  Parameters 

( r ( t ),  v ( t ) ) : Extrapolated  inertial  state  vector  ( corresponds  to 

time  t). 

Value  of  the  dependent  variable  (the  transfer  time 
interval)  in  the  Kepler  iteration  scheme,  which  was 
calculated  in  the  last  iteration  ( should  agree  closely 
with  (t  - tg  ) ). 

Value  of  the  independent  variable  in  the  Kepler  itera- 
tion scheme  to  which  the  last  iteration  converged. 

3.2  C onic  State  Extrapolation  As  A Function  Of  Transfer  Angle 

( Theta  Routine ) 


‘t-Vc 


System 

^E 


Input  Parameters 


Gravitational  parameter  of  the  earth  (Product  of 
earth's  mass  and  universal  gravitational  constant). 
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Real-Time 


(Tq,  Vq ) : Inertial  state  vector  which  is  to  be  extrapolated. 

0 : Transfer  angle  through  which  the  extrapolation  is  to 

be  made. 

Output  Parameters 

(r,  v)  : Extrapolated  inertial  state  vector. 

(t  - t„  ) : Transfer  Time  Interval  corresponding  to  the  conic 

extrapolation  through  the  transfer  angle  6. 
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9. 6. 1.1  Conic  State  Extrapolation  (continued) 


4.  DESCRIPTION  OF  EQUATIONS 


4.  1 Conic  State  Extrapolation  As  A Function  Of  Time  (Kepler 
Routine ) 

The  universal  formulation  of  Stumpff -Herrick-Battin  in 
terms  of  the  universal  eccentric  anomaly  difference  is  used.  This 
variable,  usually  denoted  by  x,  is  defined  by  the  relations: 


x 


\|1T'(E  - E ) for  ellipse 
= < \)p^(tanf/2  - tan  f / 2 ) for  parabola 

VlP(H  - Hq)  for  hyperbola 


where  a is  the  semi-major  axis,  E and  H are  the  eccentric  anomaly 
and  its  hyperbolic  analog,  p is  the  semi-latus  rectum  and  f the  true 
anomaly.  The  expressions  for  the  transfer  time  interval  (t  - tQ) 
and  the  extrapolated  position  and  velocity  vectors  ( r,  v)  in  terms  of 
the  initial  position  and  velocity  vectors  (r^,  v^ ) as  functions  of  x 
are; 

(Universal  Kepler  Equation) 


(t  -t0) 


_ 1 

\[^E 


° x2  C ( a0  x2  ) + ( 1 - rQ  «0  ) x3  S ( x2  ) + rQ  x 


NpE1 


r(t)  = 

2 „ 

1 - — C (a  x^  ) 

£o  + 

<,-y  --~s(«0x2) 

r° 

\jME 

^0 


v(t)  = 


E 


r r. 


3 0 , 2 . 

ffgX  S («Q  X ) - X 


Io  + 


1 X „ , 2 . 

1 - — C ( a x ) 
r 


^0 
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9. 6. 1.1  Conic  State  Extrapolation  (continued) 


where 


and 


a0 


2 v0 


a0  r0 


S(5)  .i  .£+L 

3!  5!  7! 


C(S)  = i - £ + L_ 

2!  4!  6! 


Since  the  transfer  time  interval  ( t - t ) is  given,  it  is  desired  to 
find  the  x corresponding  to  it  in  the  Universal  Kepler  Equation,  and 
then  to  evaluate  the  extrapolated  state  vector  (r,  v)  expression 
using  that  value  of  x.  Unfortunately,  the  Universal  Kepler  Equation 
expresses  (t  - tQ)  as  a transcendental  function  of  x rather  than  con- 
versely, and  no  power  series  inversion  of  the  equation  is  known  which 
has  good  convergence  properties  for  all  orbits,  so  it  is  necessary 
to  solve  the  equation  iteratively  for  the  variable  x. 

For  this  purpose,  the  secant  method  (linear  inverse  inter- 
polation/ extrapolation)  is  used.  It  merely  finds  the  increment  in 
the  independent  variable  x which  is  required  in  order  to  adjust  the 
dependent  variable  (t  - tQ)o  to  the  desired  value  (t  - tQ ) based  on  a 
linear  interpolation/  extrapolation  of  the  last  two  points  calculated  on 
the  (t  - tg)c  vs  x curve.  The  method  uses  the  formula 


<xn+l  ' Kn ' 


(t-to)lcn)-<t-to><c'1) 


( X - X , ) 

n n- 1 
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9. 6. 1.1  Conic  State  Extrapolation  (continued) 


where  (t  - tg)  ^ denotes  the  evaluation  of  the  Universal  Kepler 
Equation  using  the  value  x^.  In  order  to  prevent  the  scheme  from 
taking  an  increment  back  into  regions  in  which  it  is  known  from  past 
iterations  that  the  solution  does  not  lie,  it  has  been  found  convenient 
to  establish  upper  and  lower  bounds  on  the  independent  variable  x 
which  are  continually  reset  during  the  course  of  the  iteration  as  more 
and  more  values  of  x are  found  to  be  too  large  or  too  small.  In  ad- 
dition, it  has  also  been  found  expedient  to  damp  by  10%  any  incre- 
ment in  the  independent  variable  which  would  (if  applied)  take  the 
value  of  the  independent  variable  past  a bound. 

To  start  the  iteration  scheme,  some  initial  guess  x^  of  the 
independent  variable  is  required  as  well  as  a previous  point  (x  , 

( - 1 ) " l 

( * “ tg  >c  ' on  the  ( t - )c  VS  x curve-  no  Previous  point  is 
available  the  point  (0,  0 ) may  be  used  as  it  lies  on  all  (t  - tg)  vs. 
x curves.  The  closer  the  initial  guess  x^  is  to  the  value  of  x corres- 
ponding to  the  solution,  the  faster  the  convergence  will  be.  One 
method  of  obtaining  such  a guess  xQ  is  to  use  a truncation  of  the 
infinite  series  obtained  by  direct  inversion  of  the  Kepler  Equation 
( expressing  x as  a power  series  in  (t  - tQ ) ).  It  must  be  pointed  out 
that  this  series  diverges  even  for  "moderate"  transfer  time  inter- 
vals (t  - tQ);  hence  an  iterative  solution  must  be  used  to  solve  the 
Kepler  equation  for  x in  the  general  case.  A third  order  truncation 
of  the  inversion  of  the  Universal  Kepler  Equation  is: 

x = XX(t-V” 

n = 0 

I 

where 
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9. 6. 1.1  Conic  State  Extrapolation  (continued) 


4.2  Conic  State  Extrapolation  As  A Function  of  Transfer  Angle 
( Theta  Routine  ) 

As  with  the  Kepler  Routine,  the  universal  formulation  of 
Stumpff-Herrick-Battin  in  terms  of  the  universal  eccentric  anomaly 
difference  x is  used  in  the  Theta  Routine.  A completely  analogous 
iteration  scheme  could  have  been  formulated  with  x again  as  the  in- 
dependent variable  and  the  transfer  angle  0 as  the  dependent  variable 
using  Marscher's  universally  valid  equation: 

, 2 c , 2 , 

1 -aflx  S (nQx  ) 

cot  - = + cot 

\[pPx  C (a0  x2  ) 

where 


and 


However,  in  contrast  to  the  Kepler  equation,  it  is  possible 
to  invert  the  Marscher  equation  into  a power  series  which  can  be 
made  to  converge  as  rapidly  as  desired,  by  means  of  which  x may  be 
calculated  as  a universal  function  of  the  transfer  angle  9.  Knowing 
x,  we  can  directly  calculate  the  transfer  time  interval  (t  - tg ) and 
subsequently  the  extrapolated  state  vectors  using  the  standard 
formulae. 

The  sequence  of  computations  in  the  inversion  of  the 
Marscher  Equation  is  as  follows: 

Let 


/ U u \ ■ L* 

P = ( ) Sin  y 

re 

"Vq  = angle  from  r^  to  Vq. 


PN  = P/r0’  °N  " " r0 

and 
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9 . 6 . 1 . 1 Conic  State  Extrapolation  (continued) 


If 


wrW~  • cot  V- 


1 - cos  9 


Wx  >1,  let  Vj  = 1. 


Let 


W , , = + 
n+1 


2 1 l i 

\ W + a . T + W ( 
' n N n ' 


W, 


<1) 


or 


Let 


V„+l  ■ +f„2+‘»N<lI/Wj>2l  + V„ 


<0  = W 

n n 


W, 


( W, 


>1) . 
<1) 


or 


Let 


V<-n  = (|  i/w1|)/vn  ( Wx  >1). 


u n 2j+l  « * 
n j = 0 J n 


where  n is  an  integer  >4.  Then 


W\p 


N 


(w:  > 0) 


2 (Wj  < 0) 


The  above  equations  have  been  specifically  formulated  to  avoid  certain 
numerical  difficulties. 
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9. 6. 1.1  Conic  State  Extrapolation  (continued) 


5.  DETAILED  FLOW  DIAGRAMS 

5.  1 Conic  State  Extrapolation  As  A Function  of  Time  (Kepler 
Routine ) 

SYSTEM  REAL  TIME  (Required)  REAL  TIME  (Optional) 


Fipure  3a  KEPLER  ROUTINE  DETAILED  FLOW  DIAGRAM 
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9. 6. 1.1  Conic  State  Extrapolation  (continued) 


Figure  3b  KEPLER  ROUTINE  DETAILED  FLOW  DIAGRAM 
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9 .6 .1.1  Conic  State  Extrapolation  (continued) 


Figure  3c  KEPLER  ROUTINE  DETAILED  FLOW  DIAGRAM 
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Figure  3d  KEPLER  ROUTINE  DETAILED  FLOW  DIAGRAM 
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9. 6. 1.1  Conic  State  Extrapolation  (continued) 


5.2  Conic  State  Extrapolation  As  A Function  of  Transfer  Angle 


SYSTEM 


ENTER 

REAL-TIME 

— oj  V 0 


Xo  ' ^0 


6 = 6-  sign  ( 6 ) 360 
n = n + 1 


9. 6. 1.1  Conic  State  Extrapolation  (continued) 


Figure  4b  THETA  ROUTINE  DETAILED  FLOW  DIAGRAM 
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9. 6. 1.1  Conic  State  Extrapolation  (continued) 


Figure  4c  THETA  ROUTINE  DETAILED  FLOW  DIAGRAM 


\ 
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9. 6. 1.1  Conic  State  Extrapolation  (continued) 


5.  3 Subroutines  Used  By  The  Transfer  Time  or  Transfer  Angle 
Conic  Extrapolation  Routines 

5.3.1  Universal  Kepler  Equation 


SYSTEM  REAL-TIME 


Figure  5 UNIVERSAL  KEPLER  EQUATION  DETAILED  FLOW  DIAGRAM 
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9 . 6 . 1 . 1 Conic  State  Extrapolation  (continued) 
5.3.2  Extrapolated  State  Vector 


SYSTEM  REAL  TIME 


Figure  6 EXTRAPOLATED  STATE  VECTOR  EQUATION 
DETAILED  FLOW  DIAGRAM 
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9. 6. 1.1  Conic  State  Extrapolation  (continued) 


5,3.3  Secant  Iterator 


Figure  7 SECANT  ITERATOR  DETAILED  FLOW  DIAGRAM 
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Figure  8a  MARSCHER  EQUATION  INVERSION  DETAILED  FLOW  DIAGRAM 
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9. 6. 1.1  Conic  State  Extrapolation  (continued) 


Figure  8b  MARSCHER  EQUATION  INVERSION  DETAILED  FLOW  DIAGRAM 
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9. 6. 1.1  Conic  State  Extrapolation  (continued) 
6.  SUPPLEMENTARY  INFORMATION 


The  analytic  expressions  for  the  Universal  Kepler  Equation 
and  the  extrapolated  position  and  velocity  vectors  are  well  known  and 
are  given  by  Battin  ( 1964  ).  Battin  also  outlines  a Newton  iteration 
technique  for  the  solution  of  the  Universal  Kepler  Equation;  this  tech- 
nique converges  somewhat  faster  than  the  secant  technique  but 
requires  the  evaluation  of  the  derivative.  It  may  be  shown  that  if  the 
derivative  evaluation  by  itself  takes  more  than  44%  of  the  computa- 
tion time  used  by  the  other  calculations  in  one  pass  through  the  loop, 
then  it  is  more  efficient  timewise  to  use  the  secant  method. 

Marscher's  universal  equation  for  cot  0/2  was  derived  by 
him  in  his  report  ( Marscher,  1965),  and  is  the  generalization  of  his 
"Three-Cotangent"  equation: 

r ( E - En ) 

cot  L = __Y_  Cot + cot  ->  _ 

2 N[plP  2 U 

Marscher  has  also  outlined  in  the  report  an  iterative  method  of  ex- 
trapolating the  state  based  on  his  universal  equation.  The  inversion 
of  Marscher's  universal  equation  was  derived  by  Robertson  (1967a). 

Krause  organized  the  details  of  the  computation  in  both 

routines. 


A derivation  of  the  coefficients  in  the  inversion  of  the  Uni- 
versal Kepler  Equation  is  given  in  Robertson  ( 1967  b)  and  Newman 
( 1967). 


9.6-30 


9. 6. 1.1  Conic  State  Extrapolation  (continued) 
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the  precision  trajectory.  The  filter-weighting  matrix  extrapolation  equations 
have  been  modified  and  expanded  to  account  for  the  cross-correlation  terms 
when  a weighting  matrix  involving  two  state  vectors  is  being  extrapolated.  The 
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^.6.1.2  Precision  State  Extrapolation 
1.  INTRODUCTION 

The  Precision  State  and  Filter  Weighting  Matrix  Extrapola- 
tion Routine  provides  the  capability  to  extrapolate  any  spacecraft 
geocentric  state  vector  either  backwards  or  forwards  in  time  through 
a force  field  consisting  of  the  earth's  primary  central-force  gravita- 
tional attraction  and  a superimposed  perturbing  acceleration.  The 
perturbing  acceleration  may  be  either  the  single  dominant  term  (Jg  ) 
of  the  earth's  oblateness  or  a more  complete  expression  involving 
all  significant  perturbation  effects.  The  Routine  also  provides  the 
capability  of  extrapolating  the  filter-weighting  matrix  along  the  preci- 
sion trajectory.  This  matrix,  also  known  as  the  "W-matrix",  is  a 
square  root  form  of  the  error  covariance  matrix  and  contains  statisti- 
cal information  relative  to  the  accuracies  of  the  state  vectors  and 
certain  other  optionally  estimated  quantities. 

On  any  one  call,  the  routine  extrapolates  only  one  state  vec- 
tor and  only  those  six  rows  of  the  filter- weighting  matrix  relating  to 
this  state  vector.  Two  calls  are  required  to  extrapolate  two  separate 
state  vectors  and  a complete  filter-weighting  matrix  pertaining  to  two 
state  vectors.  The  complete  extrapolated  filter-weighting  matrix  is 
obtained  by  properly  adjoining  the  two  separately  extrapolated  sub- 
matrices of  six  rows  each. 

The  routine  is  merely  a coded  algorithm  for  the  numerical 
solution  of  modified  forms  of  the  basic  differential  equations  which 
are  satisfied  by  the  geocentric  state  vector  of  the  spacecraft's  center 
of  mass  and  by  the  filter-weighting  matrix,  namely: 


and 


— r(t)  + 
dt2  ” 


r3(t) 


r(t)  = ( t ) 


— W(t)  = F(t)  W ( t ), 
dt 


where  a d ( t ) is  the  vector  sum  of  all  the  desired  perturbing  accelera- 
tions, and  F(t)  is  a matrix  containing  the  gravity  gradient  matrix 
and  the  identity  matrix  in  its  off-diagonal  sub-blocks. 

Because  of  its  high  accuracy  and  its  capability  of  extrapola- 
ing  the  filter-weighting  matrix,  this  routine  serves  as  the  computa- 
tional foundation  for  precise  space  navigation.  It  suffers  from  a 
relatively  slow  computation  speed  in  comparison  with  the  Conic  State 
Extrapolation  Routine. 


■■ 
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r9.6. 1.2  Precision  State!  Extrapolation!,  (continued)  ^ 
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f(q) 

G(t) 

-pole 


I 


3 


j 


J 


2 
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NOMENCLATURE 

Perturbing  acceleration  at  time  t 

Constant  for  adjustment  of  nominal  step-size 

Number  of  columns  in  the  filter  weighting  sub- 
matrix W 

Covariance  matrix  of  dimension  d 
Special  function  of  q defined  in  text 
Gravity  gradient  matrix 

Unit  vector  of  earth's  north  polar  axis  expressed 
in  reference  coordinates 

Unit  vector  in  the  direction  of  the  position 
vector  r 

Three-dimensional  identity  matrix 

Number  of  additional  quantities,  such  as  land- 
mark locations  or  instrument  biases,  being 
estimated. 

Constant  describing  dominant  term  of  earth's 
oblateness 

Special  function  of  r and  <5  defined  in  text 
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9. 6. 1.2  Precision  State  Extrapolation  (continued) 


r(t) 
r ( t ) 
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— con 


(t) 


r ( t ) 
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t 
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F 
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x 


Geocentric  position  vector  at  time  t^ 

Geocentric  position  vector  at  time  t 

Magnitude  of  geocentric  position  vector 

Reference  conic  position  vector  at  time  t 

Magnitude  of  reference  conic  position  vector 
at  time  t 

Mean  equatorial  radius  of  the  earth 
Geocentric  position  vector  at  time  t ^ 
Intermediate  values  of  r 

Switch  indicating  the  perturbing  accelerations 
to  be  included 

Switch  controlling  whether  state  or  filter- 
weighting matrix  integration  is  being  per- 
formed (used  only  internally  in  routine) 

Initial  time  point 

Time  to  which  it  is  desired  to  extrapolate 
( r o > vQ  ) and  optionally  WQ 

Geocentric  velocity  vector  at  time  tg 

Geocentric  velocity  vector  at  time  t p. 

Reference  conic  velocity  vector  at  time  t 

Filter-weighting  matrix  at  time  tQ 

Filter-weighting  matrix  at  time  t^ 

Three-dimensional  column  vectors  into  which 
the  filter-weighting  matrix  is  partitioned 

Independent  variable  in  Kepler  routine 
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x' 

y(t) 
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<5 

max 
A t 

^ t max 
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£(  t) 

n(  t ) 
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Previous  value  of  x 

Vector  random  variable  of  dimension  j representing 
errors  in  the  additionally  estimated  quantities  such 
as  landmark  locations  or  instrument  biases 

Position  deviation  vector  of  true  position  from 
reference  conic  position  at  time  t 

Maximum  value  of  j 6 | permitted  (used  as  rectifica- 
tion criterion) 

Time-step  size  in  numerical  integration  of  differential 
equation 

Maximum  permissible  time-step  size 

Nominal  integration  time-step  size 

Time  convergence  tolerance  criterion 

Random  variable  representing  error  in  estimate 
of  position  vector  at  time  t 

Random  variable  representing  error  in  estimate 
of  velocity  vector  at  time  t 

Earth's  gravitational  parameter 

Velocity  deviation  vector  of  true  velocity  from 
reference  conic  velocity  at  time  t 

Maximum  value  of  | v | permitted  (used  as 
rectification  criterion) 

Time  interval  since  last  rectification 

Previous  value  of  r 

Geocentric  latitude 
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9. 6. 1.2  Precision  State  Extrapolation  (continued) 


2.  FUNCTIONAL  FLOW  DIAGRAM 


The  Precision  State  and  Filter  Weighting  Matrix  Extrapola- 
tion Routine  performs  its  functions  by  integrating  modified  forms  of 
the  basic  differential  equations  at  a sequence  of  points  separated  by 
intervals  known  as  time -steps,  which  are  not  necessarily  of  the  same 
size.  The  routine  automatically  determines  the  size  to  be  taken  at 
each  step. 


As  shown  in  Fig.  1,  the  state  vector  and  (optionally)  the 
filter-weighting  sub -matrix  are  updated  one  step  at  a time  along  the  pre- 
cision trajectory  until  the  specified  overall  transfer  time  interval  is 
exactly  attained.  (The  size  of  the  last  time-step  is  adjusted  as  neces- 
sary to  make  this  possible.  ) 
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9. 6. 1.2  Precision  State  Extrapolation  (continued) 


3.  INPUT  AND  OUTPUT  VARIABLES 

The  Precision  State  and  Filter  Weighting  Matrix  Extrapolation 
Routine  has  the  following  input  and  output  variables; 

Input  Variables 

( rQ  , Vq)  Geocentric  state  vector  to  be  extrapolated 

tQ  Time  associated  with  (£o-£q)  and  W0 

t ^ Time  to  which  it  is  desired  to  extrapolate 

P 

(rQ.  vQ)  and  optionally  WQ 


W, 


Filter-weighting  sub-matrix  to  be  extra- 
polated (optional)  ( WQ  has  dimension  6 x d) 


d 


Spert 


Number  of  columns  in  filter-weighting  sub- 
matrix (d  = 0,  6,  7,  ....  where  0 indicates 
no  W-matrix  extrapolation) 


Switch  indicating  the  perturbing  accelera- 
tions to  be  included.  (spert  = 1 implies  J 
oblateness  term  only;  Spert  > 1 implies  a 
more  complete  perturbing  acceleration 
model  (or  models).) 


2 


Output  Variables 

(r„,  v„)  Extrapolated  geocentric  state  vector 

— r — r 

W.,  Extrapolated  filter-weighting  sub-matrix 

P 

of  dimension  6 x d 
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9. 6. 1.2  Precision  State  Extrapolation  (continued) 


4.  DESCRIPTION  OF  EQUATIONS 

4. 1 Precision  State  Extrapolation  Equations 

Since  the  perturbing  acceleration  is  small  compared  with  the 
central  force  field,  direct  numerical  integration  of  the  basic  differ- 
ential equations  of  motion  of  the  spacecraft  state  vector  is  inefficient. 
Instead,  a technique  due  to  Encke  is  utilized  in  which  only  the  devia- 
tions of  the  state  from  a reference  conic  orbit  are  numerically  integrated. 
The  positions  and  velocities  along  the  reference  conic  are  obtained 
from  the  Kepler  routine. 

At  time  tQ  the  position  and  velocity  vectors,  r^  and  Vq  , define 

an  osculating  conic  orbit.  Because  of  the  perturbing  accelerations, 

the  true  position  and  velocity  vectors  r (t)  and  v(t)  will  deviate  as 

time  progresses  from  the  conic  position  and  velocity  vectors  r (t) 

—con 

and  Vcon(t)  which  have  been  conically  extrapolated  from  r^  and  v^. 

Let 


*<*>  ■ £<*>  - Icon111 
vM  ■ v(t)  - v^lt) 


be  the  vector  deviations.  It  can  be  shown  that  the  position  deviation 
6_(t)  satisfies  the  differential  equation 


— 6<t)  + — 

dt2  r 3 ( t ) 

con  L. 


f(q)  r (t)  + 6 ( t ) 


= id(t) 


with  the  initial  conditions 


i(tQ)  = 0,  v(tQ)  = 0 


where 


9. 6. 1.2  Precision  State  Extrapolation  (continued) • 


6 


f ( q ) = q -Ltia  + H2  , 
1 + (1  + q)3/2 


and  a^  (t ) is  the  total  perturbing  acceleration.  The  above 
second  order  differential  equation  in  the  deviation  vector  6(t) 
is  numerically  integrated  by  a method  described  in  a later  sub- 
section. 

The  term 

f(q)  r(t)  +6(t) 

must  remain  small,  i.  e.  of  the  same  order  as  a^lt),  if  the  method 
is  to  be  efficient.  As  the  deviation  vector  £jt)  grows  in  magnitude, 
this  term  will  eventually  increase  in  size.  When 


|_6<t)!  > O.Ollr^mi  or  \u(t)\  > 0.  01 1 ( t )| 

or  when 


I *(t)l>fimax  orl  H(t)  I > vmax' 


a new  osculating  conic  orbit  is  established  based  on  the  latest  preci- 
sion position  and  velocity  vectors  r (t)  and  v(t),  the  deviations  6 (t) 
and  y(t)  are  zeroed,  and  the  numerical  integration  of  6 (t)  and  y(t) 
continues.  The  process  of  establishing  a new  conic  orbit  is  called 
rectification. 

The  total  perturbing  acceleration  arf  ( t)  is  in  general  the 
vector  sum  of  all  the  desired  individual  perturbing  accelerations  com- 
prising the  total  force  field,  such  as  those  due  to  the  earth's  oblate- 
ness, the  gravitational  attractions  of  the  sun  and  moon,  and  the  earth's 
atmospheric  drag.  Since  many  Shuttle  applications  will  require  only 
the  perturbing  effect  of  the  dominant  term  J 2 of  the  earth's  oblate- 
ness, the  use  of  only  this  term  has  been  made  a standard  option  in 
the  routine  diagrammed  in  Section  5.  However,  provision  has  been 
made  for  handling  a completely  general  perturbing  acceleration.  The 
form  of  this  perturbing  acceleration  will  depend  primarily  upon  the 
requirements  of  the  Orbit  Navigation  function. 
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9.6.1. 2 Precision  State  Extrapolation  (continued) 


The  explicit  expression  for  the  earth's  J ^ oblateness  accel 
e ration  alone  is: 

,2 


^d 


JL  J-  j 

2 2 d 2 


2 

(1-5  sin  0)_ir  + 2 sin  0 .ipole 


where 


i is  the  unit  position  vector  in  reference  coordinates, 


i , is  the  unit  vector  of  the  earth's  north  polar 
-pole 

axis  expressed  in  reference  coordinates. 


sin*  = 2r  * Ipole, 


and 

r^  is  the  mean  equatorial  radius  of  the  earth. 

4.  2 Filter-Weighting  (W)  Matrix  Extrapolation  Equations 

The  position  and  velocity  vectors  which  are  maintained  by  the 
spacecraft's  computer  are  only  estimates  of  the  actual  values  of  these 
vectors.  As  part  of  the  navigation  technique  it  is  also  necessary  for 
the  computer  to  maintain  statistical  information  about  the  position 
and  velocity  vectors.  Furthermore,  in  particular  applications  it  is 
necessary  to  include  statistical  data  on  various  other  quantities,  such 
as  landmark  locations  during  Orbit  Navigation  and  certain  instrument 
biases  during  Co-orbiting  Vehicle  Navigation.  The  filter-weighting 
W-matrix  is  used  for  all  these  purposes. 

If  £(t)  and  n (t  ) are  three  dimensional  vector  random 
variables  with  zero  mean  which  represent  the  errors  in  the  estimates 
of  a spacecraft's  position  and  velocity  at  time  t,  then  the  six-dimen- 
sional state  error  covariance  matrix  Eg(t)  at  time  t is  defined  by: 


E g ( t ) = , 

n(t)e(t)T  n < t ) 2?  ( t ) T 

m m. 

where  the  bar  represents  the  expected  value  or  ensemble  average  at 
the  fixed  time  t of  each  element  of  the  matrix  over  which  it  appears. 


e(t)  e ( t ) 


V( t)  e(  t) 


e (t)  n(t) 


V(t)  v(t) 
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9. 6. 1.2  Precision  State  Extrapolation  (continued) 


If  y(t)  is  a j -dimensional  vector  random  variable  with  zero 
mean  which  represents  the  errors  in  the  estimates  of  the  j additionally 
estimated  quantities  such  as  landmark  locations  or  instrument  biases, 
then  a ( 6+j  ) - dimensional  state  and  other  parameter  covariance  matrix 
E(6+j)<t)  is  defined  by: 

e(t)  7(t)T 

Efi(t)  

rj  (t ) y(t)T 

y(t)e(t)T  y(t)rj(t)T  y(t)y(t)T 


E(6+j)(t) 


Further,  if  the  statistical  properties  of  the  positions  and  ve- 
locities of  two  separate  spacecraft  are  to  be  maintained,  a twelve- 
dimensional state  covariance  matrix  is  defined  by: 


1. p £ p £p  hp  £p  £'T  £p 


hp  £p  lp  Up  Zip  £p  HpUp 


E12(t>  - 


T „ T T T 

e rj-  € p £rp_p  £j  e rp  £ p II  p 


T T T T 

h T £p  HpUp  hp  £t  — T — T 


where  the  subscripts  P and  T refer  to  the  primary  and  target  ve- 
hicles, respectively. 

And  finally,  if  the  statistical  properties  of  the  j additionally 
estimated  quantities  are  also  to  be  maintained  along  with  the  two  state 
vectors,  a (12  + j ) state  and  other  parameter  covariance  matrix 
E ( 12  + j ) ( t ) is  defined  by: 
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9. 6. 1.2  Precision  State  Extrapolation  (continued) 


!p  1 


Up  1 


W'>- 


e12<0 


- It  1 


H T - 


Up' 


Up  HT  I iT  1 1 


Rather  than  use  one  of  the  above  covariance  matrices  in  the 
navigation  procedure,  it  is  more  convenient  to  use  a matrix  W^(  t) 
having  the  same  dimension  d as  the  covariance  matrix  E ^ (t)  and 
defined  by: 

Ed  (t)  = wd(t)wd(t)T 


The  matrix  Wd(t)  is  called  the  filter-weighting  matrix,  and  is  in  a 
sense  a square  root  of  the  covariance  matrix. 


Extrapolation  of  the  Wd  ( t ) matrix  in  time  may  be  made 
by  direct  numerical  integration  of  the  differential  equation  which  it  sat- 
isfies : (where  j = 0,  1,  2,  . . . is  the  number  of  additionally  estimated 

quantities  ) 


d 

d t 


W 


(6  + j) 


(t)  = 


o 

G ( t ) 

*3 

O 

1 

1 °(6xj) 

°(J  x6) 

1 °r  i 

| (J  x J ) 

d 
d t 


W(12+j)(t> 


O 

J3 

o 

o 

G p(t) 

O 

o 

o 

O 

O 

o 

1 3 

O 

o 

G T(t) 

o 

°<  j x 6 ) °( j x 6 ) 


O 


( 6xj  ) 


O 


( 6xj : 


O,  . . , 

(jxj) 


W 


(12  + j ) 


(t) 


where  I 3 is  the  3x3  identity  matrix,  the  O's  are  zero  matrices  of 
the  required  dimensions,  and  the  G(t)  are  the  3x3  conic  gravity 
gradient  matrices 
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9. 6. 1.2  Precision  State  Extrapolation  (continued) 


G ( t ) = 


r5(t) 


3 r 


(t)  r(t)  1 - r ( t ) I , 


associated  with  the  vehicle  under  consideration  or  with  the  primary  (P) 
or  target  (T)  vehicle. 

Extrapolation  of  the  Wd  matrix  may  also  be  made  by  the 
following  technique,  which  is  somewhat  simpler  to  implement  in  an 
on-board  computer  since  matrix  manipulations  are  reduced  to  more 
tractable  vector  manipulations. 


If  the  d x d filter-weighting  matrix  W d = [w^i]  is 

partitioned  into  three-dimensional  column  vectors  w^  ^ which  bear 
the  subscripts  of  their  first  component: 


W 


— 0,  0 


-0,1 


-3,0  -3,1 


-0,(d-l) 


— 3,(d-l) 


etc. 


except  for  the  last  row  where  the  w,  . vectors  may  be  one  or  two- 
dimensional  if  d is  not  divisible  by  three,  then  the  previous  first 
order  differential  equations  are  equivalent  to: 

j 2 ^ 


2 -0,i 


d t 
with 

-3,  i 

-k,  i 


Git)  w 


0,  i 


i = 0,  1,  . . . (d  - 1 ) 


dt  — 0,  i 
constant  for  k £ 6 


and 


d t ' 


wQ,i  =Gp(t)  w0;. 


d t 
with 


wc  . = Grpit)  w „ 

— 6,i  T —b,i 


i = 0,  1 (d  - 1) 


w o . 

— 3,  i 


w 

dt  — 0,i 


— 9,  i 


77  W „ . 

d t —6,i 


w . . 

— k,  i 


= constant  for  k s 12 
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9. 6. 1.2  Precision  State  Extrapolation  (continued) 


When  written  out  in  full,  the  above  equations  are: 


d t 
with 


w o ■ 
— 3,  i 


w,  . 
-k,  i 


and 

d2 

dt2 


d t 


with 


w , . 

— 3,i 


— 9,  i 

^k,i 


-0,  i 


— 3 f r ( t ) • w ( t ) 1 r ( t 

£p  (t)  j L“  -0'1  J- 


)-r^(t)Woji(t) 


i = 0,  1 (d  - 1) 


dt  — 3,  i 


constant  for  k 


w n - 

— 0,  l 


2 — 6,  i 


^7  t3[£p(t)’ 

[lT(t>  • ^6,i(t) 


£p(t)  - rp  (t)  w_0j.  (t) 


rT5(t) 


r rj-(t)  - rT  (t)  Wg  .(t) 


i = 0,  1 (d  - 1 ) 


d t -0,i 
d 

dt  -6,  i 

constant  for  k a 12 


These  second-order  differential  equations  may  be  integrated  using  the 

same  numerical  integration  technique  as  is  used  for  the  spacecraft 

position  vector.  The  vectors  w„  . and  w_  . bear  the  same  relation- 

o » i 9 1 i 

ship  to  the  spacecraft  velocity  vector  as  the  vectors  w „ . and  w„  . 

bear  to  the  spacecraft  position  vector,  and  w „ . and  w_  . are  a 

— 3,  i —9,  i 

by-product  of  the  numerical  integration  of  w^  . and  wg  just  as 
the  velocity  vector  is  a by-product  of  the  numerical  integration  of  the 
position  vector. 
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9. 6. 1.2  Precision  State  Extrapolation  (continued) 


4.  3 Numerical  Integration  Method 

The  extrapolation  of  inertial  state  vectors  and  filter  weight- 
ing matrices  requires  the  numerical  solution  of  two  second-order 
vector  differential  equations,  which  are  special  cases  of  the  general 
form 

,2 

— v(t)  = f(t,  £(t),  z(t)) 
dt2 


where 


Nystrom's  standard  fourth-order  method  is  utilized  to  numerically 
solve  this  equation.  The  algorithm  for  this  method  is: 


W=  Zn  + ^^+^k1+k2  +k3)(At)2 

b 

— n+l  = + ^ — 1 + 2—2  + 2—3  + ^4  } At 

*1  = L(tn'  2n*  *n> 

k„  = f ( t + - At,  v + - z At  + - k,  ( At  )2 , z + - k.  At ) 

-i  - n 2 ^ 2 8 _n  2 

—3  = L(tn  + JAt'  At+^l(At)2'  ^n  + ^2  At) 

iLj  = f_  (tn  + At,  M + - kg  ( At)2,  z^  + kg  M) 

2 

where 

Zn  = Z<V'  —n  = *(tn> 

and 
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>■<,0.1.2  Precision  State  Extrapolation  (continued) 


As  can  be  seen,  the  method  requires  four  evaluations  of 
Mt,  y,  z ) per  integration  step  At  as  does  the  classical  fourth-order 
Runge-Kutta  method  when  it  is  extended  to  second-order  equations. 
However,  if  £ is  independent  of  z,  then  Nystrom's  method  above  only 
requires  three  evaluations  per  step  since  kg  = k2<  (Runge-Kutta's 
method  will  still  require  four). 


The  integration  time  step  At  may  be  varied  from  step  to 
step.  The  nominal  integration  step  size  is 


At 

nom 


c 

nom 


r 

con 


3/2//F 


where  c 


nom 


is  a program  constant.  (The  value  c 


nom 


0.  3 is 


recommended  and  implies  that  about  21  steps  will  be  taken  per  trajec- 
tory revolution).  The  actual  step-size  is  however  limited  to  a maxi- 
mum of  At  max  , which  is  also  a program  constant.  (A  value  of  about 
4000  seconds  is  suggested.)  Also,  in  the  last  step,  the  actual  step 
size  is  taken  to  be  the  interval  between  the  end  of  the  previous  step 
and  the  desired  integration  endpoint,  so  that  the  extrapolated  values 
of  the  state  or  W-matrix  are  immediately  available.  Thus  the  integra- 
tion step-size  At  is  given  by  the  formula 


At  = + minimum  (I  t„-  1 1,  At  , At  ) 

- 'h'  nom’  max 

where  t^  is  the  desired  integration  end-point  and  t is  the  time  at  the 
end  of  the  previous  step.  The  plus  sign  is  used  if  forward  extrapola- 
tion is  being  performed,  while  the  negative  sign  is  used  in  the  back- 
dating case. 
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9. 6. 1.2  Precision  State  Extrapolation  (continued) 


5.  DETAILED  FLOW  DIAGRAMS 

This  section  contains  detailed  flow  diagrams  of  the  Preci- 
sion State  and.  Filter  Weighting  Matrix  Extrapolation  Routine. 

Each  input  and  output  variable  in  the  routine  and  subroutine 
call  statements  can  be  followed  by  a symbol  in  brackets.  This  symbol 
identifies  the  notation  for  the  corresponding  variable  in  the  detailed 
description  and  flow  diagrams  of  the  called  routine.  When  identical 
notation  is  used,  the  bracketed  symbol  is  omitted. 
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Figure  2a.  Detailed  Flow  Diagram 


9.6-50 


Figure  2b.  Detailed  Flow  Diagram 
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1 


(Figure  2e ) 


Figure  2c.  Detailed  Flow  Diagram 
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9.6.1. 1 Precision  State  Extrapolation  (continued) 


r = T + At/2 


lb  - t ^ V At  \ y - — con  ' -con 

2r  2rcon  ^ 

\ con  / 2 

Ax=  0 1 -Y»(1-2Y»)  -4-  --rT— V 

L \ K con  / 


x = x'  + Ax 


Call  Kepler  Routine  (Ref.  8) 


Input:  rQ.  v0,r[At],x,  x'  [x'c],t'  [Atc'] 

°utPut:  Icon  [l]’  Icon  [>]*  X'  [Xc]’  T'[Atc] 


(Figure  2b) 


(Figure  2b) 


Figure  2d.  Detailed  Flow  Diagram 


4, 


6 = 6 + \ (k1  + k2  + k 3)  At  j At 

v = if+^(k1  + 2k2+2k3  + k4)At 


Figure  2e.  Detailed  Flow  Diagram 
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9. 6. 1.2  Precision  State  Extrapolation  (continued) 


6.  SUPPLEMENTARY  INFORMATION 

Encke's  technique  is  a classical  method  in  astrodynamics 
and  is  described  in  all  standard  texts,  for  example  Battin  (1964). 

The  f (q)  function  used  in  Encke's  technique  (and  in  the  lunar-solar 
perturbing  acceleration  computations)  has  generally  been  evaluated 
by  a power  series  expansion;  the  closed  form  expression  given  here 
was  derived  by  Potter,  and  is  described  in  Battin  (1964). 

The  oblateness  acceleration  in  terms  of  a general  spherical 
harmonic  expansion  may  be  calculated  in  a variety  of  ways;  three 
different  recursive  algorithms  are  given  in  Gulick  (1970).  For  low 
order  expansions,  especially  those  involving  mostly  zonal  terms,  an 
explicit  formulation  is  generally  superior  computation-time-wise,  as 
only  the  non-zero  terms  enter  into  the  calculation.  The  general  ex- 
pression for  the  zonal  terms  is  given  by  Battin  (1964),  while  Zeldin 
and  Robertson  (1970)  give  explicit  analytic  expressions  for  each  of 
the  tesseral  terms  up  through  fifth  order;  hence  all  combinations  of 
terms  may  easily  be  included  in  the  oblateness  acceleration  by  con- 
sulting the  formulations  in  these  references. 

A full  discussion  of  the  use  of  covariance  matrices  in  space 
navigation  is  given  in  Battin  (1964).  Potter(1963)  suggestedtheuse  of 
the  W-matrix  and  developed  several  of  its  properties.  It  should  be  noted 
that  strictly  the  gravity  gradient  matrix  G(t)  should  also  include  the 
gradient  of  the  perturbing  acceleration;  however,  these  terms  are  so 
small  that  they  may  be  neglected  for  our  purposes.  The  use  of  only 
the  conic  gravity  gradient,  however,  does  not  imply  the  W-matrix  is 
being  extrapolated  conically.  (Conic  extrapolation  of  the  W-matrix 
can  be  performed  by  premultiplying  the  W-matrix  by  the  conic  state 
transition  matrix,  which  can  be  expressed  in  closed  form ).  Rather 
the  W-matrix  is  here  extrapolated  along  the  precision  (perturbed) 
trajectory,  as  can  be  seen  from  the  detailed  flow  diagram  of  Section 
5. 
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The  Nystrom  numerical  integration  technique  was  first  con- 
ceived by  Nystrom  (1925),  and  is  described  in  all  standard  texts  on 
the  numerical  integration  of  ordinary  differential  equations,  such  as 
Henrici  ( 1962  ).  Parametric  studies  carried  out  by  Robertson  (1970) 
on  the  general  fourth-order  Runge-Kutta  and  Nystrom  integration 
techniques  indicate  that  the  "classic"  techniques  are  the  best  overall 
techniques  for  a variety  of  earth  orbiting  trajectories  in  the  sense  of 
minimizing  the  terminal  position  error  for  all  the  trajectories, 
although  for  any  one  trajectory  a special  technique  can  generally  be 
found  which  decreases  the  position  error  after  ten  steps  by  one  or 
two  orders  of  magnitude  for  only  that  trajectory.  The  classical 
fourth -order  Runge-Kutta  and  Nystrom  techniques  are  approximately 
equally  accurate,  but  the  latter  possesses  the  computational  advant- 
age of  requiring  one  less  perturbing  acceleration  evaluation  per  step 
when  the  perturbing  acceleration  is  independent  of  the  velocity.  This 
fact  has  been  taken  into  account  in  the  detailed  flow  diagram  of  Section 
5,  in  that  the  extra  evaluation  is  performed  only  when  the  perturbing 
acceleration  depends  explicitly  on  the  velocity.  Some  past  Apollo  ex- 
perience has  suggested  that  extra  evaluation  effect  with  drag  is  so 
small  as  to  be  negligible;  further  analysis  will  confirm  or  deny  this 
for  the  Space  Shuttle.  In  regard  to  step-size,  the  constants  and  the 
functional  form  of  the  nominal  and  maximum  time-step  expressions 
have  been  determined  by  Marscher  (1965). 
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systems  and  a ground  beacon  orbit  navigation  system.  With  minor 
modifications,  the  equations  may  be  readily  adapted  to  other  orbit 
navigation  systems  such  as  known  or  unknown  landmark  tracking,  or 
to  systems  using  different  sensors,  e.g.  radar  altimeter. 
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9*6,1*3  Orbit  Navigation  Using  Navigation  Sensors  (continued) 


!.  INTRODUCTION  AND  FUNCTIONAL  FLOW  DIAGRAM 

The  purpose  of  the  Orbit  Navigation  function  is  to  provide  a 
means  of  automatically  reducing  uncertainties  in  the  on-board 
knowledge  of  the  SSV  (primary  vehicle)  inertial  state  by  accepting 
and  processing  data  from  the  navigation  sensor  ( s ).  This  knowledge 
is  required  to  (a)  accurately  compute  orbital  maneuvers,  (b)  pro- 
vide accurate  initial  conditions  for  other  mission  phases  such  as 
rendezvous,  deorbit  and  landing. 

There  are  several  candidate  orbit  navigation  systems  for  the 
shuttle  mission  e,  g. ; 

1.  horizon  sensing 

2.  tracking  ground  based  beacons 

3.  tracking  navigation  satellites 

4.  tracking  satellites  ejected  from  the  primary  vehicle 

The  navigation  equations  required  for  systems  ( 3 ) or  ( 4 ) fall  in  the 
category  of  relative  state  updating  and  are  documented  in  Ref.  1. 

This  document  will  present  the  equations  required  for  horizon  sensing 
systems  and  a ground  beacon  orbit  navigation  system.  In  the  horizon 
sensing  system,  the  direction  of  the  line-of-sight  to  a horizon  is 
measured  with  respect  to  inertially  fixed  coordinates  provided  by 
the  inertial  measurement  unit  (IMU  ).  In  the  ground  beacon  system, 
transponders  located  at  known  positions  on  the  earth  are  interrogated 
by  the  SSV  navigation  system.  The  return  signals  from  the  transponders 
provide  range  to  the  beacon  and  / or  range  rate  relative  to  the  beacon. 

With  minor  modifications,  the  equations  presented  for  these 
two  systems  may  be  readily  adapted  to  other  orbit  navigation  systems, 
such  as  known  or  unknown  landmark  tracking,  or  to  systems  using 
different  navigation  sensors,  e.g.  radar  altimeter. 
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9. 6,1. 3 Orbit  Navigation  Using  Navigation  Sensors  (continued) 


A general  flow  diagram  of  this  function  is  presented  in 
Fig.  1.  The  inputs  required  by  this  function  are; 

1.  On-board  estimate  of  primary  vehicle  state  (Xp)  with 
time  tag. 

2.  Initial  filter  weighting  matrix  (W) 

3.  A priori  sensor  measurement  variance 

4.  Navigation  sensor  measurements 

and  if  ground  beacon  navigation  is  used 

5.  Latitude  and  longitude  of  next  ground  beacon(s) 
encountered. 

The  output  of  this  function  is  an  updated  estimate  of  the 
primary  vehicle  state.  This  output  is  available  after  each  measure- 
ment incorporation. 

The  system  depicted  in  Fig.  1 operates  as  follows:  Naviga- 
tion sensor  data  are  accepted  at  discrete  "measurement  incorporation 
times".  The  estimate  of  the  primary  vehicle  state  is  updated  at 
each  of  these  times  by  processing  the  sensor  data  in  the  measure- 
ment incorporation  routine.  If  more  than  one  piece  of  sensor  data 
is  to  be  incorporated  at  a given  time  ( e.g.  range  and  range  rate 
relative  to  a ground  beacon)  each  piece  of  data  is  incorporated  in- 
dependently in  a sequential  fashion. 

A precision  extrapolation  routine  extrapolates  the  primary 
vehicle  state  and  filter  weighting  matrix  from  one  "measurement 
incorporation  time"  to  the  next.  This  routine  is  described  in  f?ef.  2. 
For  the  ground  beacon  navigation  system,  a prediction  scheme  is 
described  which  determines  which  of  the  ground  beacons  stored  in  a 
catalog  will  be  encountered  next  by  the  primary  vehicle,  and  at  what 
time  this  will  occur  so  that  the  on-board  interrogator  may  be  turned 
on  a sufficient  time  prior  to  this  encounter. 
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9.61.3  Orbit  Navigation  Using  Navigation  Sensors  (continued) 


Figure  1 ORBIT  NAVIGATION  FLOW  DIAGRAM 
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9. 6. 1.3  Orbit  Navigation  Using  Navigation  Sensors  (continued) 


NOMENCLATURE 


a 

UNIT  ( a ) 


bF(I) 


Magnitude  of  vector  a 
Unit  vector  ( a / a ) 

Fischer  ellipsoid  semi-major  axis  in  equatorial  plane 

Angle  between  reference  frame  x axis  and  earth  fixed 
frame  x axis  (zero  longitude  in  equatorial  plane)  at 
launch  epoch  (tQ ) 

Radius  of  Fischer  ellipsoid  which  corresponds  to  a 
latitude  equal  to  I 


6 -dimensional  measurement  geometry  vector 


3 -dimensional  measurement  geometry  vectors  asso- 
ciated with  £p,  Vp 


I 


Inclination  angle  between  horizon  measurement  plane 
and  equatorial  plane 


ID 

ID 


Beacon  identification  code  of  next  beacon  encountered 

Beacon  identification  code  of  j th  beacon  encountered 
within  15  minutes  of  last  beacon  ( j = 1,2) 


LATBp,,  Latitude,  longitude  of  Kth  ground  beacon  of  total  of  n 

LONGBk  beacons  (K  = 1,  2,  3,  ...  n) 


MNB-m  Transformation  matrix  from  navigation  base  axes  to 

navigation  sensor  axes.  M^g  m is  fixed  according 
to  spacecraft  configuration. 
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9. 6. 1.3  Orbit  Navigation  Using  Navigation  Sensors  (continued) 


Transformation  matrix  from  earth  fixed  frame  (z- 
north  pole,  x-in  equatorial  plane  at  0°  long. , y- 
completes  right  hand  system ) to  reference  coordinate 
frame  (in  which  initial  state  is  expressed  and  compu- 
tations are  performed ).  M_,  „ is  determined  from 

“*  K. 

initially  and  is  updated  using  earth  spin  rate  and 
elapsed  mission  time. 


MR-SM 


Transformation  matrix  from  reference  coordinate  frame 
to  stable  member  axes.  is  given  from  specified 

platform  alignment. 


Msm-NB  Transformation  matrix  from  stable  member  axes  to 

navigation  base  axes  on  which  IMU  is  mounted,  MgM.jsiB 
is  determined  from  IMU  gimbal  angles. 

n total  number  of  ground  beacons 


nv 


number  of  ground  beacons  visible  within  15  minutes 
of  each  other 


QEST 

«i 

-B 

RBr 

5bp 

—PH 

-P 

ORBWFLAG 


On-board  estimate  of  measured  parameter 

ith  measured  parameter  at  tm 

Ground  beacon  position  vector 

Altitude  of  Kth  ground  beacon 

Position  vector  of  rp  relative  to  rp 

Horizon  position  vector  from  earth  center 

Position  vector  of  rp  relative  to  rp 

Primary  vehicle  position  vector 

"0"  - W is  left  as  extrapolated  from  Precision 
Integration  routine  (initially  set  to  "0"). 

"l"  - W is  set  to  pre-loaded  value  given  by  Wp 
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9. 6. 1.3  Orbit  Navigation  Using  Navigation  Sensors  (continued) 


m 


TI.  TI. 


VAR 
VAR  ^ 


varh 

w 


Launch  epoch 
Present  time 

Measurement  Incorporation  time 

Time  of  initiation  of  ground  beacon  search 

Ground  beacon  search  initiation  time  of  next  beacon 
encountered,  of  j th  beacon  encountered  within  15 
minutes  of  last  beacon  (j  = 1,2). 

Velocity  vector  of  ground  beacon  relative  to  vp 

A priori  filter  measurement  error  variance 

A priori  random  measurement  error  variance  for 
horizon  angle  y 

A priori  random  horizon  threshold  variance 
6X6  filter  weighting  matrix  associated  with  xp 
Pre-loaded  value  of  initial  filter  weighting  matrix 
Pre-loaded  value  to  which  W is  reinitialized 


6 -dimensional  primary  vehicle  state  vector 


Pre-stored  horizon  threshold  altitude 

Time  increment  between  measurement  incorporation 
times 


6x 


6 -dimensional  navigation  update  of  xp 


'B 


Angle  above  horizontal  at  which  ground  beacon  is 
"visible". 
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9. 6. 1.3  Orbit  Navigation  Using  Navigation  Sensors  (continued! 


H Gravitational  constant 

t Orbital  period 

0 Pre-loaded  horizon  direction  azimuth  angles  in  vehicle 

local  horizontal  plane,  measured  from  foward  direc- 
tion 

^ Angle  from  navigation  sensor  boresight  axis  (xm) 

to  horizon 

w Earth  spin  rate  vector 
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9. 6. 1.3  Orbit  Navigation  Using  Navigation  Sensors  (continued) 


2.  DESCRIPTION  OF  EQUATIONS 


The  equations  involved  in  the  Measurement  Incorporation 
Routine  of  the  orbit  navigation  function  are  described  in  this  section. 
In  addition,  equations  are  described  for  the  prediction  scheme  re- 
quired with  a ground  beacon  orbit  navigation  system.  Except  where 
specifically  noted,  measurement  incorporation  equations  are  appli- 
cable to  both  horizon  sensing  and  ground  beacon  orbit  navigation 
systems. 

2. 1 Ground  Beacon  Prediction  Routine 

In  a ground  beacon  orbit  navigation  system,  a network  of 
ground  beacons  (transponders)  will  be  strategically  located 
on  the  earth.  The  locations  ( latitude,  longitude  ) of  these  beacons 
will  be  stored  in  the  on-board  computer.  The  function  of  the  Ground 
Beacon  Prediction  Routine  is  to  ( a)  provide  an  estimate  of  the  time 
the  primary  vehicle  will  be  in  "viewing"  range  of  the  next  ground 
beacon  so  that  the  on-board  beacon  interrogator  may  be  activated 
prior  to  this  time  and  (b)  provide  the  measurement  incorporation 
routine  the  coordinates  of  the  next  beacon  encountered. 

The  beacon  prediction  scheme  to  be  described  consists 
mainly  of  logic  statements  with  few  equations.  Thus,  the  detailed 
description  will  be  left  for  the  flow  diagram  section  and  a brief  word 
description  will  be  given  here. 

At  a prescribed  time  (tg),  the  beacon  search  is  initiated. 

In  order  to  save  computer  time,  conic  extrapolation  of  a dummy 
state  vector  (to  preserve  the  permanent  state  vector)  is  utilized  in 
the  search  routine.  The  search  interval  is  constrained  in  order  to 
minimize  the  error  resulting  from  conic  approximation.  This  con- 
straint is  achieved  by  specifying  a maximum  search  interval  of  1/2 
orbit,  and  reinitiating  the  search  1/4  orbit  later.  In  this  manner, 
closely  spaced  or  overlapping  beacons  are  not  missed. 
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9. 6. 1.3  Orbit  Navigation  Using  Navigation  Sensors  (continued) 


The  dummy  state  is  extrapolated  in  1 minute  intervals.  At 
each  interval  all  the  stored  beacon  locations  are  examined  for  visi- 
bility until  one  passes  the  visibility  criterion  ( i.  e.  the  dummy  state 
is  within  a cone  shown  in  Fig.  2 ).  After  finding  a visible  beacon, 
the  search  is  continued  until  one  of  the  following  constraints  is  violated: 

(a)  another  beacon  has  not  been  found  visible  within  15 
minutes  of  the  first  beacon  intercept; 

(b)  three  beacons  have  been  found  visible  within  15 
minutes  of  each  other  (the  number  three  is  arbitrary, 
but  in  the  final  beacon  network,  there  will  most  likely 
not  be  over  three  closely  spaced  beacons). 

If  no  visible  beacons  are  found  within  1/  2 orbit,  the  search  is  stopped 
and  reinitiated  1/4  orbit  later. 

After  finding  a visible  beacon  ( or  2 or  3 closely  spaced 
beacons),  the  on-board  interrogator  is  turned  on  10  minutes  prior 
to  the  predicted  intercept  of  the  first  visible  beacon.  After  naviga- 
tion updating  across  this  beacon,  either  of  two  options  is  executed: 

(a)  if  another  beacon  is  predicted  within  15  minutes  of 
the  previous  encounter,  the  interrogator  is  informed 
of  the  next  beacon  identification  and  interrogation  is 
initiated, 

(b)  if  a visible  beacon  is  not  predicted  within  15  minutes 
of  the  last  beacon,  the  search  is  reinitiated  1 minute 
after  the  cessation  of  navigation  updating. 

The  above  scheme  may  not  be  the  one  ultimately  coded  for  the 
Orbital  Coast  Navigation  Module  whenthe  final  beacon  network  has 
been  established.  It  does,  however,  represent  a "brute  force" 
approach  which  is  not  overly  expensive  in  computer  time.  (A  half 
orbit  search  should  take  approximately  10-15  seconds  assuming 
computer  comparable  to  the  AGC  is  utilized).  For 
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horizontal 


Figure  2.  Beacon  Visibility  Constraint 
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example,  if  only  U.S,  based  beacons  are  required,  the  search  may 
be  simplified  considerably  by  just  waiting  some  short  time  prior  to 
stateside  pass  before  determining  the  visible  beacon  ( s ) and  turning 
on  the  interrogator. 

2.2  Measurement  Incorporation  Routine 

i 

Computation  of  measurement  geometry  vector  (b),  estimate 
of  measured  parameter  (Qgg-p)  and  measurement  variance  (VAR  ). 


Compute  relative  position  vector  from: 
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9. 6. 1.3  Orbit  Navigation  Using  Navigation  Sensors  (continued) 


A.  1 Range  Measurement 

Compute  / bp  A 


from 


^P,  0 " " U— BP 


-P,  3 - 


Compute  QggT  ^rom: 


QEST  = RBP 


A.  2 Range  Rate  Measurement 

Compute  relative  velocity  vector  from: 


-BP 


= yE  x lB 


' -p 


Compute  b from 


bp>  o = URBp  X ( URBp  X VBp  ) / RBp 
^.p,  3 = ' U— BP 


Compute  from 


qest  = -BP  • u5bp 
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9. 6. 1.3  Orbit  Navigation  Using  Navigation  Sensors  (continued) 


Computation  of  VAR 

The  computation  of  VAR  will  depend  on  the  error  model 
ultimately  formulated  for  ground  beacon  measurements.  The 
current  model  assumes  a constant  value  of  VAR  for  either 
range  or  range  rate  measurements.  This  value  will  be  pre- 
stored in  the  computer. 


B.  Horizon  Sensing  Orbit  Navigation 

Navigation  analyses  for  SSV  missions  will  determine  the  required 
directions  for  horizon  measurements  in  order  to  achieve  the 
desired  performance  without  excessive  attitude  maneuvers. 

The  horizon  direction  for  a particular  measurement  may  be 
described  by  an  azimuth  angle  (0 ) measured  from  the  down- 
range  direction  in  the  local  horizontal  plane.  (See  Fig.  3). 

Compute  local  vertical  frame  axes  from; 

UZ  = UNIT  ( rp ) 

UY  = UNIT  (£pXvp) 

UX  = UY  x UZ 

Computation  of  Vector  to  Horizon  (£pp)  (Ref.  4) 

Using  the  current  value  of  0,  from  the  pre-scheduled 
sequence  of  horizon  measurement  directions,  compute: 

•$>  = cos  0 UX  + sin  0 UY  ( Fig.  3 ) 

Define  unit  vector  normal  to  horizon  measurement  plane 
from: 


= UNIT  ( 0 X rp ) 
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9. 6. 1.3  Orbit  Navigation  Using  Navigation  Senaora  (continued) 


and  two  orthogonal  unit  vectors  in  the  horizon  measurement 
plane  from 


Lq  = UNIT  ( i^  X i_2  > 


i-1  = i-2  X io 


( i„  is  in  equatorial  plane  and  i is  in  direction  of  north 
— u ~^T 

pole  given  by  third  row  of  Mg  _ p ) 

* 

Compute  inclination  angle  between  horizon  measurement 
plane  and  equatorial  plane  from 

I = sin'1  ( i_x  • ig  ) 

Compute  Tp  and  0 in  horizon  plane  coordinate  system  (i^, 
i_l , i_2  ) from: 


From  the  Fischer  ellipsoid  and  a pre -stored  horizon  thres- 
hold altitude  ( y^  ),  compute  the  semi-major  and  semi-minor 
axes  of  the  horizon  measurement  plane  ellipse  from: 


aH  ' aF  + yH 


bH  bF  ( 1 J + 7H 
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9. 6. 1.3  Orbit  Navigation  Using  Navigation  Sensors 

where : 

ap  is  Fischer  semi-major  axis  in  equatorial  plane 

b„(I)  radius  of  Fischer  ellipsoid  which  corresponds 
r 

to  a latitude  equal  to  I. 

Compute  the  following  quantities: 
d =XH2/aH2+YH2/bH2 

e =(an  YH+Njd  - l')/d  bH 
f =(bHXH\|d  - l')/daH 

Compute  horizon  position  vector  from: 


Compute  vector  to  horizon  from: 

r = r - r 
—PH  -H  -P 


Compute  elevation  angle  to  horizon  ( £ ) (Fig. 4 ) from: 
? = cos'1  j^UNIT  (rpH)  • ^ J 


(continued) 
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Figure  3.  Definition  of  Horizon  Measurement  Plane 


Figure  4.  Horizon  Sensor  Coordinate  Frame  Geometry 
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9. 6. 1.3  Orbit  Navigation  Using  Navigation  Sensors  (continued) 


If  S > ?r/  2 recompute  rH>  rpH  and  £ from: 


-PH  = * -P 

§ = cos"1  £ UNIT  ( rpH  ) -_0HJ 
Compute  rpH  in  reference  coordinates  from: 


-PH  MR  -H  -PH 


U-PH  = UNIT 


(-PH 


) 


From  0 and  f , vehicle  attitude  is  adjusted  so  that  sensor 
coordinate  xm  (Fig.  4 ) is  maintained  in  horizon  measure- 
ment plane  within  sensor  field  of  view  from  rD„ 

Compute  xm  in  reference  coordinates  from: 


-m  = MSM-R  MNB-SM  Mm-NBl 


9.6  - 75 


9. 6. 1.3  Orbit  Navigation  Using  Navigation  Sensors  (continued) 


Compute  measurement  geometry  vectorl 


( -p.»\ 

\-'^.3  rm: 


-P,  0 = UNIT  ( u-ph  x < £p x u£ph  > > / r 


PH  — P —PH ' ' ' PH 


-P,  3 - 


Compute  Qgg-p  ( angle  >l>  in  Figure  4 ) from: 

QeST  = 008-1  (xm  • UIPH)[SIGN((£mXuIpH)  • (£pXu^PH))] 


Compute  VAR  from: 

VAR  = VAR^  + VARh/  rpH 

State  Vector  and  Filter  Update  at  Measurement  Incorporation  Time 

The  filter  weighting  matrix  ( W ) is  available  from  one  of 
the  following  sources: 

At  the  first  measurement  incorporation: 

1.  Pre-loaded  values  based  on  mission  simulations 
Between  measurement  incorporations  at  a given  t ; 

2.  From  the  computation  (below)  after  a measurement 
incorporation 


At  the  first  measurement  incorporation  of  new  t : 
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3.  From  the  Precision  Extrapolation  Routine 

4.  From  pre-stored  reinitialization  values  at  prescribed 
reinitialization  times. 

Compute  6 -dimensional  z vector  from: 

T 

z = W b 
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9. 6. 1.3  Orbit  Navigation  Using  Navigation  Sensors  (continued) 


3.  DETAILED  FLOW  DIAGRAMS 


This  section  contains  detailed  flow  diagrams  for  the 
Measurement  Incorporation  Routine  of  the  Orbital  Coast  Navigation 
Module;  and  for  use  with  ground  beacon  orbit  navigation  system,  the 
prediction  scheme  for  determining  the  next  beacon  encountered  and 
the  encounter  time. 
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Figure  5a.  Detailed  Flow  Diagram 

Ground  Beacon  Prediction  Routine 
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Figure  5b.  Detailed  F low  Diagram 

Ground  Beacon  Prediction  Routine 
(Beacon  Visibility  Check) 


9.6  - 80 


Figure  5c.  Detailed  Flow  Diagram 

Ground  Beacon  Prediction  Routine 
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Figure  6a.  Detailed  Flow  Diagram 

Measurement  Incorporation  Routine 
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Figure  6b.  Detailed  Flow  Diagram 

Measurement  Incorporation  Routine 


9.6  - 83 


9. 6. 1.3  Orbit  Navigation  Using  Navigation  Sensors  (continued) 


Figure  6c.  Detailed  Flow  Diagram 

Measurement  Incorporation  Routine 
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Figure  6e.  Detailed  Flow  Diagram 

Measurement  Incorporation  Routine 
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9. 6. 1.3  Orbit  Navigation  Using  Navigation  Sensors  ( continued 
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Figure  6d.  Detailed  Flow  Diagram 

Measurement  Incorporation  Routine 

9.6  = 85 


Figure  6f.  Detailed  Flow  Diagram 

Measurement  Incorporation  Routine 
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Figure  6g.  Detailed  Flow  Diagram 

Measurement  Incorporation  Routine 
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Figure  6h.  Detailed  Flow  Diagram 

Measurement  Incorporation  Routine 
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Figure  6i.  Detailed  Flow  Diagram 

Measurement  Incorporation  Routine 
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9. 6. 1.3  Orbit  Navigation  Using  Navigation  Sensors  (continued) 

4.  SUPPLEMENTARY  INFORMATION 

The  equations  presented  in  this  report  are  the  results  to 
date  of  studies  performed  under  a G&C  shuttle  task  to  develop 
G&N  equations  for  automatic  orbit  navigation.  For  the  system  to 
be  fully  automated,  an  automatic  mark  reject  routine  remains  to  be 
formulated.  In  addition,  a filter  weighting  matrix  reinitialization 
schedule  must  be  prescribed.  For  a ground  beacon  navigation 
system,  preliminary  analyses  indicate  the  W matrix  should  be  re- 
initialized when  it  has  been  "used"  for  more  than  an  orbit.  (Ref.  3). 
Also,  if  widely  spaced  beacons  are  used,  this  reinitialization  should 
be  performed  approximately  3 navigation  marks  into  a beacon  pass. 

For  closely  spaced  beacon  pairs  the  reinitialization  may  be  performed 
prior  to  the  first  mark  on  a beacon  pass. 

The  prescribed  horizon  directions  ( <f> ) have  not  been 
finalized.  Preliminary  analyses  (Ref.  5)  indicate  a satisfactory 
schedule  might  consist  of  a series  of  forward  sightings  and  a series 
of  backward  sightings  in  the  orbital  plane,  and  a few  sightings  to 
each  side  of  the  orbital  plane.  The  final  schedule  must  take  into 
account  sunlight  constraints  assuming  the  horizon  sensor  utilizes 
ultra-violet  radiation.  A sunlit  horizon  prediction  scheme  will  then 
also  be  required  to  be  incorporated  in  the  navigation  equations. 

The  horizon  sensor  assumed  for  the  equations  presented 
in  this  document  utilizes  a single  degree  of  freedom  scan  to  determine 
the  angle  from  it6  boresight  axis  to  the  horizon  sighted.  This  re- 
quires the  attitude  control  system  to  maintain  the  sensor  "scan 
axis"  to  be  normal  to  the  estimated  vehicle  position  vector  with  the 
sensor  boresight  axis  at  a prescribed  azimuth  angle  from  the 
forward  direction  and  within  the  sensor  field  of  view  from  the  horizon. 
The  final  equations  will  of  course  be  a function  of  the  actual  sensor 
operating  characteristics  and  its  location  on  the  spacecraft. 
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FINE  ALINEMENT  OF  THE  SPACE  SHUTTLE  INERTIAL 
REFERENCE  UNIT  BY  THE  MULTI -MODE  OPTICAL  SENSOR 


Summary 

After  a brief  description  of  the  Multi-Mode  Optical  Sensor  and  its  ope- 
rational characteristics,  a procedure  is  developed  for  fine  alinement 
of  the  Space  Shuttle’s  Inertial  Reference  Unit  (IRU)  by  means  of  two 
successive  star  sightings.  Then,  the  basic  equations  are  derived  for 
use  in  computer  simulations  of  the  sensor's  operation  in  a realistic 
environment.  Sample  results  from  a computer  simulation  of  these  equa- 
tions have  been  included  in  an  appendix. 

Introduction 


Description  of  the  Multi-Mode  Optical  Senses*  - For  a hi^h- inertia  vehi- 
cle like  the  Shuttle,  where  reliability  requirements  are  extremely  high, 
the  apparent  best  choice  for  an  optical  alinement  sensor  is  a wide- 
field,  strapped-down,  electronically-gimballed  star  tracker.  The  poten- 
tial flexibility  of  this  type  of  sensor  for  such  additional  applications 
as  sunlit  target  tracking  for  rendezvous,  and  ultra-violet  horizon  track- 
ing for  orbital  navigation,  make  this  a very  attractive  choice  for  the 
Shuttle.  The  basic  performance  parameters  for  the  sensor  to  be  des- 
cribed have  been  proven  in  various  applications  aboard  unmanned  space 
vehicles  and  rocket-borne  experiment  payloads. 

An  engineering  model  of  the  Multi-Mode  Optical  Sensor  is  currently  be- 
ing procured  for  evaluation.  The  design  requirements  for  this  sensor 
will  provide  a capability  to: 

a.  Acquire  the  brightest  star  (brighter  than  +3.0  visual  magni- 
tude) within  the  sensor's  17°-by-17°  square  field  of  view. 

b.  Acquire  any  star  brighter  than  +3.0  visual  magnitude  within  a 
square  search  field  2°  on  a side,  centered  about  a point  which  can  be 
computer-directed. 

c.  Track  a star  (or  sunlit  rendezvous  target)  within  an  accuracy 
of  one  minute  of  arc  (one  sigma)  relative  to  the  bore-sight  axis. 
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d.  Under  computer  control,  execute  a radiometric,  earth-horizon 
profile  scan  to  determine  the  altitude  of  the  selected  horizon  point  in 
vehicle-centered  inertial  coordinates  for  orbital  navigation. 

The  detector  in  the  sensor  being  procured  is  to  be  an  ITT  Image  Dissec- 
tor Type  4012  tube,  with  an  S-20  photocathode.  An  objective  aperture 
of  about  2 inches  at  an  f-number  of  approximately  unity  will  provide 
the  required  field  dimensions.  The  instantaneous  field  of  view  in  such 
a sensor  is  set  by  the  mechanical  size  of  the  aperture  hole  Inside  the  , 
image  dissector.  For  the  present  application,  it  is  anticipated  that 
a one-quarter  degree  subtense  will  be  selected.  In  the  acquisition 
modes,  this  instantaneous  field  will  be  caused  by  magnetic  deflection 
coils  to  sweep  the  search  field  of  view  in  a sequentially-stepped,  cas- 
ter-type scan.  At  each  point  the  average  energy  in  the  instantaneous 
field  of  view  will  be  sampled  for  a dwell  time  of  230  microseconds. 
Reference  1 contains  more  details  of  the  functional  operation  of  the 
detector  and  of  the  sensor. 

After  acquisition  of  the  stay,  the  tracker  switches  to  a track  mode  for 
higher  accuracy.  In  this  mode,  the  instantaneous  field  of  view  is  rap- 
idly swept  over  the  target  in  a manner  which  will  provide  error  signals 
to  the  deflection  circuits  to  keep  the  target  centered  in  the  tracking 
field.  The  accuracy  of  this  target  centering  is  expected  to  be  about 
30  seconds  of  arc  (one  sigma),  and  is  dependent  mainly  upon  the  target's 
signal-to-noise  ratio. 

At  any  time  after  tracking  begins,  the  star’s  location  relative  to  the 
sensor’s  field  of  view  center  can  be  read  out  by  external  command.  In 
addition  to  the  tracking  accuracy  mentioned  above,  there  will  be  a non- 
linearity error  component  in  the  angle  readout,  which  is  due  to  scale 
factor  non-linearity  in  the  deflection  circuitry.  This  error  is  ex- 
pected to  be  between  one-half  and  one  minute  of  arc,  but  may  be  par- 
tially compensated  by  additional  electronic  circuitry  or  by  the  onboard 
computer. 

Mechanically,  the  optical  sensor  is  expected  to  weigh  approximately  15 
pounds,  including  electronics  and  optics,  and  will  operate  on  about  20 
watts  electrical  input  power  at  28  volts  D.C. 

Summary  of  Assumptions  Pertaining  to  Fine  Alinement 

a.  Computer  Control  of  the  Alinement  Procedure  - Complete  con- 
trol of  the  IRU  alinement  procedure  is  assumed  to  be  contained  within 
the  Flight  Control  Computer  (FCC) . A monitor  display  will  be  provided 
to  the  crew  at  critical  decision  points.  As  presently  envisioned, 
these  decisions  should  include  only  those  affecting  or  requiring  atti- 
tude maneuvering  fuel,  or  the  actual  process  of  torquing  the  IRU  gimbals. 
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The  decision  to  perform  an  IRU  fine  alinement  procedure  may  be  made  by 
the  FCC,  although  provision  -will  be  made  for  manual  request  of  this  ac- 
tion. Thus,  the  crew  may  obtain  an  IRU  fine  alinement  in  preparation 
for  an  unscheduled  flight  activity,  for  which  the  FCC  has  no  informa- 
tion. But,  in  most  cases,  the  FCC  will  request  a new  alinement  because 
the  time  lapse  since  the  previous  alinement  has  become  too  long  for  ac- 
ceptable attitude  accuracy.  If  the  FCC  is  informed  in  advance  of  mis- 
sion events  upcoming,  then  it  can  decide  logically  what  level  of  atti- 
tude accuracy  will  be  acceptable,  and  execute  the  alinement  at  an  opti- 
mum time.  This  advance  notice  may  well  allow  "stars  of  opportunity"  to 
be  used  without  expenditure  of  attitude  maneuvering  fuel.  The  proce- 
dures developed  in  this  report  were  based  upon  this  assumption  primari- 
ly. Preliminary  results  have  indicated  that  this  is  a reasonable  ap- 
proach. 

b.  Number  of  Sensors  - For  description  purposes,  it  has  been  as- 
sumed that  three  identical  Multi— Mode  Optical  Sensors  will  be  located 

on  the  vehicle.  Each  will  have  a separate  (non-overlapping)  field  cove- 
rage, and  each  sensor  will  have  a well-known  orientation  with  respect  to 
the  SSV  navigation  base.  It  has  also  been  assumed  that  the  FCC  will 
have  command  control  over  these  sensors  sufficient  to  allow  power  switch- 
ing, protective  cover  removal  and  return,  selection  of  modes,  and  con- 
trol over  the  deflection  circuitry  within  the  sensor. 

c.  Navigation  Star  Catalog  - A catalog  of  star  vectors  will  be 
available  to  the  FCC.  (See  Appendix  A).  This  catalog  will  contain  all 
the  stars  that  are  brighter  than  +3.0  visual  magnitude  (approximately 
150),  and  will  include  tables  of  planet  positions  for  the  planets  hav- 
ing acceptable  brightness.  These  will  include  Venus,  Mars,  and  Jupiter. 
Presumably,  the  locations  of  the  sun,  earth  and  moon  are  also  available 
with  adequate  precision  because  of  their  perturbation  effects  on  the 
gravitational  potential  in  the  near-earth  environment. 

Coordinate  System  Definitions 

a.  Body  Coordinate  System  - The  SSV  body  coordinate  system  is 
illustrated  in  Figure  1.  It  consists  of  an  orthogonal,  three-axis  sys- 
tem, with  the  +XB  axis  directed  out  the  forward  portion  of  the  fuselage, 
and  with  the  +Yjj  axis  pointed  out  the  right  wing.  The  +Z3  axis  is  di- 
rected out  the  bottom  of  the  vehicle  to  complete  a right-handed  system. 

In  this  system,  positive  roll  (defined  as  rotation  about  the  X axis) 
will  bring  the  +Y  axis  toward  the  +Z  axis,  positive  pitch  (rotation  a- 
bout  the  Y axis)  will  carry  the  +Z  axis  toward  the  +X  axis,  and  positive 
yaw  (rotation  about  the  Z axis)  will  bring  the  +X  axis  closer  to  the  +Y 
axis.  The  origin  of  this  coordinate  system  is  located  at  the  nominal 
center-of-gravity  of  the  vehicle. 

Since  the  order  of  performing  attitude  maneuvers  is  critical  to  this 
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description,  some  convention  has  to  he  adopted  in  order  to  develop 
meaningful  equations.  For  the  purposes  of  this  report,  it  has  been  as- 
sumed that  maneuvers  will  be  carried  out  in  the  order  of  first  roll, 
then  pitch,  and  finally  yaw, 

b.  Navigation  Base  Coordinate  System  - The  navigation  base  co- 
ordinate system  consists  of  an  orthogonal  set  of  axes  which  are  defined 
to  be  parallel  to  the  SSV  body  coordinate  system  described  above,  but 
with  the  origin  offset  from  the  nominal  center-of-gravity  by  some  unde-' 
termined  distance  and  direction.  The  coordinate  axes  are  identified 
as  X^b,  YNB,  and  %B‘ 

c»  Sensor  Coordinate  System  - The  locations  of  each  sensor  in 
the  navigation  base  coordinate  system  will  be  expressed  in  the  form  of 
coordinate  translations  parallel,  respectively,  to  the  Xjjg,  Yj®,  and 
coordinate  axes.  Any  location  within  the  field  of  view  of  a par- 
ticular sensor  will  be  expressed  in  terms  of  an  azimuth  angle and  an 
elevation  angle  fil  . The  angle  relates  the  rotation  of  the  <Ki , sys- 
tem about  the  sensor  field  of  view  center  to  the  navigation  base  coor- 
dinate system.  The  angle  Vi  will  be  referred  to  as  the  tilt  angle. 

There  is  a three-axis  rotational  transformation  between  the  navigation 
base  coordinate  system  and  the  sensor  field  of  view  coordinate  system. 
The  transformation  will  be  shown  to  be  a function  of  and  the 

three  angles  which  relate  the  direction  of  the  center  of  the  field  of 
view  to  the  navigation  base  axes. 


Description  of  the  Procedure 

Decision  to  Aline  - The  logical  decision  to  perform  an  alinement  may  be 
based  upon  the  following  conditions: 

a.  The  elapsed  time  since  the  previous  alinement,  when  multiplied 
by  the  uncompensated  gyro  drift  rate,  indicates  that  the  estimated  atti- 
tude error  will  exceed  the  tolerance  required  for  the  next  flight  phase. 

b.  Selection  of  fine  alinement  may  be  requested  by  other  FCC  pro- 
grams having  to  do  with  inflight  calibration  of  inertial  or  optical  sen- 
sors. 


c.  Manual  request  for  alinement  may  be  made  by  crew  option  in 
order  to  prepare  for  a special  maneuver  or  other  flight  events. 

Star  Selection  Process  - A method  of  star  selection  has  been  developed 
specifically  for  use  with  a wide-field  sensor  in  a fixed  installation 
on  a high-inertia  vehicle.  The  primary  intent  is  to  minimize  the  fuel 
expenditure  by  making  maximum  use  of  the  computational  capability  a- 
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vailable  in  the  FCC. 

Upon  receipt  of  an  alinement  request,  the  FCC  first  computes  the  cur- 
rent (time  = t0)  direction  cosines  in  inertial  coordinates  for  the 
three  individual  sensor  centerlines.  Next,  the  FCC  will  carry  out  an 
update  of  the  vehicle's  inertial  state  vector  estimate  to  the  time  tG. 
Based  upon  this  vehicle  position  and  upon  the  ephemerides  of  the  sun  and 
the  earth,  the  FCC  then  excludes  from  further  consideration  any  sensor 
which  is  looking  within  30  degrees  of  the  sun,  or  which  is  completely 
blocked  off  by  the  earth.  Only  the  usable  sensors  are  included  in  the 
following  calculations. 

Next,  the  inertial  direction  of  each  of  the  usable  sensors  in  turn  is 
compared  to  the  star  vectors  in  the  catalog.  If  the  star  does  fall 
within  the  field  of  view  of  a usable  sensor,  it  is  subjected  to  the  fol- 
lowing tests: 

a.  Is  it  occulted  by  the  earth?  (Note:  The  sensor-to-earth 

test  above  is  designed  to  allow  the  use  of  a sensor  which  has  part  of 
its  view  blocked  by  the  earth.  As  a result  it  is  also  necessary  to 
check  the  particular  star  to  be  used.) 

b.  Is  the  star  too  close  to  the  moon?  As  with  the  sun,  it  is 
anticipated  that  the  sensor  will  not  be  able  to  track  a star  too  close 
to  the  moon.  A tolerance  of  about  5 degrees  is  expected. 

After  all  of  the  stars  have  been  tested  with  each  of  the  usable  sensors, 
the  FCC  must  now  decide  if  an  alinement  is  possible  at  time  tc,  and  if 
not,  determine  & strategy  for  accomplishing  the  alinement  at  a later 
time.  If  there  are  two  or  more  stars  available  at  tD,  the  alinement 
can  be  immediately  carried  out  if  the  particular  pair  of  stars  availa- 
ble pass  a separation  angle  criteria.  The  angle  between  the  two  stars 
must  be  large  enough  to  provide  a satisfactory  orientation  reference 
for  the  alinement.  A preliminary  specification  for  this  angle  has  been 
estimated  at  35<T^sa<£l45  degrees. 

If  there  are  not  two  available  stars  which  can  pass  this  test,  then  the 
FCC  attempts  to  plan  a delayed  sighting  sequence  which  could  be  carried 
out  if  the  computer  is  allowed  to  inhibit  the  attitude  control  thrusters. 
This  planning  function  Is  accomplished  by  having  the  FCC  integrate  the 
body  attitude  rates  in  one  minute  steps  for  a maximum  of  ten  minutes, 
with  the  new  sensor  pointing  directions  being  used  in  the  star  selec- 
tion procedure.  The  process  is  repeated  until  two  stars  have  been  found 
which  meet  the  separation  angle  criteria,  or  until  after  the  tenth  ite- 
ration. 

Upon  completion  of  the  star  selection  process,  the  crew  will  be  Informed 
by  an  appropriate  display  if  the  FCC  has  had  to  assume  thruster  inhibit 
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action  in  order  to  perform  the  alinement.  The  crew  may  then  permit 
this  action,  or  if  time  permits,  elect  to  postpone  the  alinement  until 
a later  time  at  which  the  sensor  directions  may  be  more  favorable.  If 
time  is  very  limited,  the  crew  may  decide  to  perform  an  attitude  maneu- 
ver to  improve  the  sensor  orientations  with  respect  to  the  stars.  There 
is  no  provision  in  this  alinement  routine  to  assist  the  crew  in  select- 
ing a preferred  attitude. 

Auto-Optics  Command  - When  this  portion  of  the  procedure  is  begun,  there 
will  exist  at  least  one  available  catalog  star  within  the  field  of  view 
of  one  sensor.  The  inertial  coordinates  of  the  star  are  known  in  the 
star  catalog,  and  the  transformation  matrix  relating  the  inertial  coor- 
dinate system  to  the  navigation  base  coordinate  system  is  known  with 
fair  accuracy,  at  least  within  one  degree  (three  sigma).  Then,  with 
the  relatively  well-known  transformation  from  the  navigation  base  to 
sensor  coordinates,  it  becomes  possible  to  compute  the  approximate 
(two-axis)  sensor  coordinates  to  the  desired  star.  The  FCC  then  con- 
verts these  two  sensor  coordinate  angles  into  digital  format  for  trans- 
mittal to  the  appropriate  sensor. 

At  the  sensor,  the  two  digital  quantities  will  be  used  directly  to  ini- 
tialize the  reacquisition  mode  center  position.  The  sensor  will  then 
carry  out  a systematic  raster  scan  of  an  angular  region  measuring  two 
degrees  on  a side,  centered  about  the  auto-optics  command  position. 
Figure  2 illustrates  the  field  of  view  layout  in  the  reacquisition  mode. 

If  no  star  is  acquired,  the  sensor  notifies  the  FCC  and  automatically 
continues  to  try  for  acquisition  by  searching  the  entire  field  of  view 
for  the  brightest  star.  In  this  latter  instance,  the  FCC  should  inform 
the  crew  that  the  IRU  performance  has  possibly  been  degraded,  as  evi- 
denced by  a higher  than  normal  gyro  drift  rate.  Final  proof  of  this, 
however,  will  require  completion  of  the  IRU  alinement  in  order  to  rule 
out  optical  sensor  malfunctions. 

Star  Acquisition  - After  the  sensor  has  acquired  a star,  the  sensor 
switches  to  a tracking  mode.  In  the  tracking  mode,  the  two  star  angle* 
may  be  read  out  from  the  sensor  at  any  time  by  the  FCC.  There  is  at 
present  no  intention  to  use  the  signal  level  to  determine  the  star  mag- 
nitude of  the  acquired  star. 

"Mark”  Data  Processing  - At  any  time  after  tracking  has  begun,  the  com- 
puter may  issue  a digital  "Mark"  command  to  the  sensor.  Upon  receipt 
of  this  command,  the  sensor  freezes  the  tracking  circuitry  position 
voltages,  and  converts  them  to  digital  format  for  transmittal  to  the 
computer. 
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At  the  same  instant  of  the  "Mark"  command,  the  IRU  gimbal  angles  are 
also  made  available  to  the  computer  in  digital  form.  With  the  two  op- 
tics angles,  and  the  corresponding  sensor- to-navigation  base  transfor- 
mation matrix,  and  the  three  gimbal  angles,  the  FCC  can  compute  the 
measured  inertial  line  of  sight  vector  to  star  $1. 

Second  Star  Sighting  - If  the  second  star  selected  is  already  within 
the  field  of  view  of  a sensor,  the  computer  carries  out  the  second 
star  sighting  immediately.  However,  if  a delay  is  anticipated,  the 
computer  goes  to  a stand-by  posture  until  the  second  star  is  expected 
to  be  available.  When  the  sighting  becomes  possible,  the  computer  exe- 
cutes the  auto-optics  command,  the  "Mark"  command,  and  the  "Mark"  data 
processing  in  exactly  the  same  way  as  for  the  first  star. 

Preliminary  Star  Identification  Check  - At  this  point  in  the  procedure 
there  is  one  easy  test  that  the  computer  can  make  upon  the  two  star 
identifications.  This  is  the  star  angle  difference  check  that  was  used 
in  the  Apollo  computer.  The  computer  is  used  to  calculate  the  angle 
between  the  inertial  line  of  sight  vectors  to  the  two  stars  that  have 
been  measured.  Then,  a similar  calculation  is  made  with  the  unit  vec- 
tors stored  in  the  star  catalog.  The  difference  between  these  two 
angles  is  a fair  measure  of  the  overall  sighting  accuracy,  and  can  be 
used  to  rule  out  almost  all  of  the  possible  mis-identif ications  of  stars. 

It  is  impossible  to  determine  from  this  check  alone  that  the  two  stars 
have  not  been  interchanged.  Also,  with  the  larger  number  of  catalog 
stars,  and  with  the  reduced  accuracy  of  the  automatic  star  sensor  (rela- 
tive to  the  Apollo  case),  the  star  angle  difference  check  is  expected 
to  incorrectly  pass  a higher  percentage  of  star  sightings.  If  the  test 
is  failed,  the  computer  notifies  the  crew.  Otherwise,  it  proceeds  with 
the  calculation  of  gimbal  torquing  angles. 

Computation  of  Gimbal  Torquing  Angles  - The  computation  of  gimbal  torqu- 
ing angles  can  be  accomplished  using  the  two  star  vectors  which  have 
been  determined.  The  torquing  angles  are  derived  as  the  three-axis  ro- 
tation matrix  required  to  bring  the  measured  star  vectors  into  aline- 
ment  with  the  catalog  star  vectors. 

Final  Checks  - The  computed  gimbal  angle  changes  are  displayed  to  the 
crew  for  action.  If  the  angles  are  consistent  with  respect  to  the  ex- 
pected gyro  drift  rates  and  the  elapsed  time  since  the  previous  aline- 
ment  (as  determined  by  the  computer),  then  the  crew  will  probably  ac- 
cept the  alinement. 
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Equation  Development 
Transformation  of  Coordinates 

a.  Inertial-To-Orbital  Plane  Axis  System  Transformation  [120]  - 
The  inertial  coordinate  system  used  has  the  +Xp  axia  directed  at  the 
vernal  equinox,  the  +Zj  axis  pointed  toward  the  north  celestial  pole, 
and  the  +Yj  axis  oriented  to  complete  a right-handed  system.  The  ori- 
gin of  this  system  is  located  at  the  center  of  mass  of  the  earth.  For 
convenience  of  operation,  it  is  desirable  to  perform  a coordinate  trans- 
formation from  the  inertial  system  to  an  intermediate  system  referred 
to  as  the  orbital  plane  system.  In  this  new  system,  vehicle  positions 
can  be  described  as  functions  of  the  orbital  inclination,  longitude  of 
the  ascending  node,  and  the  orbital  central  angle. 

The  transformation  involved  consists  of  an  initial  rotation  about  the 
Zj  axis  by  an  an^leY^to  form  the  primed  system.  Next,  follows  a rota- 
tion about  the  Xj  axis  by  the  angle  to  obtain  'flj.e  double-primed  sys- 
tem. The  third  and  last  rotation  is  about  the  Zj  axis  (pole  of  the 
orbit)  by  the  angle  V",  which  is  the  orbital  central  angle.  The  angle 
"VS will  be  recognized  as  the  longitude  of  the  ascending  node  of  the  or- 
bit, while  the  angle  S is  the  inclination  of  the  orbit  with  respect  to 
the  inertial  coordinate  system.  These  angles  are  shown  in  Figure  3. 

These  three  rotations  make  up  the  transformation  matrix  [120],  which  is 


defined  below: 
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b.  Orbital  Plane-To-Body  Axis  System  Transformation  [02B]  - In 
the  vehicle's  body  axis  system,  the  order  of  rotation  has  been  defined 
as  first  roll,  then  pitch,  then  yaw.  The  (0°,  0°,  0°)  reference  for 
this  system  is  assumed  to  lie  along  the  vehicle  velocity  vector,  with 
the  wings  level  and  pilot  in  a "heads  up"  position.  Roll  rotation  is 
described  as  a rotation  by  the  angle -A.  about  the  XD  axis  to  form  the 
primed  system.  . Next,  pitch  is  accomplished  by  a rotation  through  the 
angle  $ about  the  YQ  axis  to  obtain  the  double-primed  systemj  Finally, 
yaw  is  effected  by  rotation  through  the  angle "X  about  the  Z5  to  arrive 
at  the  desired  body  axis  coordinate  system.  These  rotations  are  defined 
by  the  following  matrix  expression: 
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c.  Body  Axis  To  Sensor  "1"  Transformation  NB2SI  - Since  the  navi- 
gation base  coordinate  system  is  defined  to  be  parallel  -with  the  body- 
axis  coordinate  system,,  the  former  designation  will  be  used  in  the  re- 
mainder of  this  discussion.  There  are  three  sensor  orientations  for 
which  transformations  will  be  required.  The  transformation  matrix  will 
be  developed  for  the  "i-th"  sensor,  where  the  index  "i"  has  values  of 
1,  2,  and  3. 


The  first  transformation  is  an  ^ngular  rotation  about  the  Xnb  axis  by 
an  angle  to  form  the  X^,  Y^x*  ZNBI  coordinate  system.  Then  .fol- 
lows an  angular  rotationMthrough  the  angle  Sx  about  the  Yjxbi  axis  to 
obtain  the  XNBIj  YnbIj  zNBJ  coordinate  system.  Similarly,  a third  ro- 
tation is  made  about  the  ZNBI  axis  by  the  angle'll  to  complete  the  trans- 
formation. Now  the  resulting  "i-th"  sensor  coordinate  system  is  related 
to  the  navigation  base  system  by  the  equation: 


COSVyX 

sinV^i 
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d. 

Sensor  "i 

" To  Elevation/Azimuth  System  SI2EA  - In  the 

"i-th" 

sensor  coordinate  system,  the  directions  to  stars  and  other  targets  will 
be  measured  in  terms  of  azimuth  and  elevation  angles  relative  to  the  op- 
tical axis  and  to  the  sensor  vertical  and  horizontal  axes  (See  Figure 
4).  Azimuth  rotation  will  be  defined  as  a rotation  by  an  angle C^i  about 
the  axis.  Elevation  will  be  defined  similarly  as  a rotation  by  an 
angle  p\  about  the  Zgx  axis.  The  Xgp  axis  will  be  parallel  to  the  "i-th" 
sensor’s  optical  axis.  The  sense  of  the  angle ek  will  be  considered 
positive  if  the  angle  is  measured  from  the  Xsi  - Ygj  plane  toward  the 
Zgx  axis.  Since  this  is  opposite  to  the  convention  for  right-handed 
coordinate  systems,  the  transformation  has  been  defined  to  use  the  nega- 
tive value  of  cA  . The  sense  of  the  angle  will  be  considered  positive 
if  the  angle  is  measured  from  the  Xg-Zg  plane  toward  the  Yg  axis,  which 
is  in  agreement  with  the  right-handed  convention. 


The  transformation  from  the  sensor  system  to  the  elevation/azimuth  sys- 
tem is  given  by: 
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Logic  For  Decision  To  Perform  IRU  Fine  Alinement  - The.'.ECC  first  com- 
putes the  estimated  inertial  attitude  error  at  the  present  time  by  the 
following  equation: 

A-ZT-t  »XL(t  - ta) 

where:  -A-=  Uncompensated  gyro  drift  rate  magnitude  in  degrees/sec 
ta  = Time  of  previous  allnement,  in  seconds,  since  liftoff 
t = Present  time,  in  seconds,  since  liftoff 

= Estimated  inertial  attitude  error  at  present  time,  in 
degrees  (scalar  quantity) 

Depending  upon  the  magnitude  of  the  present  attitude  error,  the  FCC  may 
initiate  a fine  alinement.  The  decision  is  made  according  to  the  logic 
below: 

a. .  Prior  to  orbital  navigation  and/or  orbital  maneuvers 

IF A-n.t2A-A*ofy/,  initiate  fine  alinement 

IF  A fl_t  +A(typ  - t a)zA-fl0jy>  initiate  fine  alinement 

where:A-A-oN  = alinement  tolerance  for  orbital  navigation  and 
maneuvers 

tpp  = time  of  next  flight  plan  activity  requiring  IRU 
alinement 

b . Re-entry  Preparation 

IFA^lt— » initiate  fine  alinement 

IFA-O-t  +/\-(tpE  - t > initiate  fine  alinement 

where  :a/Lre  = alinement  tolerance  for  re-entry 

tp®  = time  of  atmospheric  re-entry,  in  seconds 


Logic  For  Star  Selection  Process  - The  center  lines  of  the  three  sen- 
sors are  first  converted  into  inertial  coordinates  by  the  transforma- 
tions below: 

3(1, t0)  = [I20]T[02B]T[NB2SI]T 


where : 


= a unit  vector  along  the  X-axis  of  the  "i-th"  sensor 


"3(l,t0)  = inertial  line  of  sight  unit  vector  of  the  "i-th" 

sensor  at  time  t0.  Body  attitude  angles -at  tc  are 
used. 


Next,  the  computer  carries  out  an  update  of  th|  vehicle  inertial  state 
vector  to  the  time,  t0.  We  call  this  vector  SV(t0),  which  contains 
three. components  of  position,  and  three  components  of  velocity,  in  in- 
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ertial  coordinates  measured  with  respect  to  the  center  of  the  earth. 
Taking  the  inverse  of  the  position  components  of  the  vehicle  state  vec- 
tor as  a vector  toward  the  center  of  the  earth,  the  computer  checks 
the  center  lines  of  each  sensor  against  this  direction  to  see  if  the 
earth  is  blocking  its  field  of  view.  Since  the  remainder  of  the  field 
may  be  usable  when  part  of  the  field  is  blocked,  this  angle  test  is  not 
conclusive.  But,  it  may  avoid  numerous  unnecessary  computation  cycles 
later  in  the  selection  process. 

First,  the  computer  determines  the  value  of  the  angled e ^-n  degrees 
given  by  the  relation: 

Tse  = sin-i(Re/l;svpos(to)l) 

where :Re=  radius  of  the  earth 

Next,  an  additional  2 degrees  is  added  to^E  to  obtain  the  effective 
earth  occultation  angle  Xed*  Til^-S  positively  prevent  the  use  of 

a star  which  could  be  situated  close  enough  to  the  atmosphere  to  cause 
a refractive  error  (See  Figure  5).  In  testing  the  sensor  centerlines, 
the  semi-field  of  view  angle  8.5  degrees  is  subtracted  from^ED*  Tken, 
if  the  angle  between  the  sensor  and  the  earth  center  is  less  than  the 
remainder,  that  sensor  will  be  completely  blocked  and  may  be  ignored 
for  the  rest  of  the  calculations  at  time  tc. 

A second  test  is  made  to  see  if  any  one  of  the  sensors  is  too  close  to 
the  sun  to  be  used.  If  the  angle  between  the  sun  and  the  centerline 
is  less  than  30  degrees,  that  sensor  will  also  be  ignored  in  the  proce- 
dures that  follow.  After  these  initial  exclusion  tests,  the  compu-* 
ter  systematically  checks  each  star  in  the  catalog  to  see  if  it  falls 
within  the  field  of  a usable  sensor.  In  equation  form, 

If  eos-lfSdjtQ)  • ST(j)]^8.5°,  the  "j-th"  star  is  within  the 
field  of  view  of  the  "i-th"  sensor. 

Next,  follows  a logical  set  of  tests  to  see  if  that  star  is  actually 
usable . 

First,  the  angle  between  the  star  and  the  center  of  the  earth  is  com- 
pared to  the  effective  earth  occultation  angle "Aed>  defined  in  the  pre- 
vious section.  If^ED  is  the  larger  of  the  two,  then  that  star  is  ex- 
cluded. This  is  accomplished  by  the  test: 

If ^ed^  cos”^[-SV(t0)  • ST(J)],  the  "j"  star  will  be  excluded. 

Next,  the  angle  between  the  moon  and  the  star  is  determined  and  com- 
pared to  a constant  angle  of  5 degrees.  If  the  star  is  within  this 
angular  radius  of  the  moon,  it  also  will  be  excluded. 
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For  those  stars  which  successfully  pass  these  tests,  the  computer 
stores  the  following  data? 

a.  Star  catalog  number,  J 

b.  Sensor  number,  I 

c.  Time  of  the  calculation,  t 

Sighting  Strategy  Logic  Equations  - After  all  the  usable  sensors  have 
been  tested  with  all  the  catalog  stars  at  the  time  tQ,  there  may  exist 
zero,  one,  or  several  available  stars  in  the  list  constructed.  If  there 
are  two  or  more  stars  available,  the  computer  can  immediately  determine 
their  acceptability  for  alinement  by  making  the  following  test: 

If  cos"1(ST(m)  • ST(n))>35°,  and^l45°,  the  two  stars  with  cata- 
log numbers  M and  N are  acceptable. 

But  if,  as  frequently  happens,  there  are  not  two  available  stars  which 
meet  this  separation  angle  requirement  at  time  tD,  the  computer  attempts 
to  predict  when  two  stars  could  be  found  if  a delay  of  up  to  ten  minutes 
were  allowed.  It  is  assumed  that  there  will  be  no  control  thruster  fir- 
ings during  the  delay  so  that  the  body  attitude  rates  existing  at  time 
tQ  may  be  expected  to  continue.  Using  the  following  equations,  the 
computer  predicts  the  vehicle  body  attitude  angles  in  one  minute  steps: 

V(t)  =V’(t0)  +V'(tQ)[t  - tD] 

S(t)  -/( t0)  +j'(t0)[t  - to] 
n(t)  ->v(t0)  +>v(to)[t  - to] 

After  each  of  these  computations,  the  star  search  procedure  is  repeated 
and  the  available  star  list  is  augmented  until  two  or  more  stars  have 
been  found  with  acceptable  separation  angles,  or  until  the  ten  minute 
delay  limit  has  been  exceeded.  In  the  latter  case,  the  crew  is  in- 
formed that  an  alinement  is  not  possible  for  the  existing  conditions. 

If  the  computer  does  find  an  acceptable  star  pair,  it  requests  the  crew 
for  permission  to  inhibit  the  attitude  control  thrusters  for  the  re- 
quired period.  If  thus  allowed,  the  computer  will  plan  the  sighting 
schedule  and  carry  out  the  alinement. 

Auto-Optics  Command  Equations  - 'When  it  has  been  established  that  a 
suitable  star  is  within  the  field  of  view  of  a particular  sensor,  the 
computer  carries  out  an  angular  transformation  to  determine  the  eleva- 
tion and  azimuth  angles  of  the  star  in  that  sensor’s  field  of  view.  The 
equations  are: 

= [SI2EA]  (NB2SI]  [02B]  [120]  ST(j) 
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The  values  ofdk  and  ft  are  then  converted  to  properly  scaled  digital 
pulse  trains  and  sent  to  the  appropriate  sensor.  The  sensor  -will  es- 
tablish a square  search  raster  centered  about  the  values  of  ci  and  , 
and  measuring  two  degrees  on  a side.  It  starts  at  (ot  -1° , f$  + 1°)  and 
moves  to  (c(  + 1°)  in  one-quarter  degree  steps.  Then,  elevation  is  re- 
duced by  one-quarter  degree,  azimuth  goes  back  to  (cX  - 1°),  and  the 
horizontal  trace  is  repeated.  This  continues  until  the  raster  is  covered 
at  (c(  + 1°,^-  1°).  Each  dwell  point  lasts  for  230  microseconds,  and 
each  full-line  retrace  takes  100  microseconds,  so  that  the  square  search 
is  completed  In  about  17  milliseconds. 

If  no  star  is  found,  the  sensor  will  automatically  extend  its  raster  to 
the  full  field  of  view  and  determine  the  location  of  the  brightest  star 
(differential  must  be  one  star  magnitude)  within  that  area.  This  full- 
field  search  is  performed  at  a rate  of  230  microseconds  per  point,  and 
one-quarter  degree  steps,  and  can  be  completed  in  approximately  one 
second. 

"Mark"  Data  Processing  Equations  - At  the  time  of  the  sighting  mark, 
tjnark?  the  computer  is  provided  with  five  anglesj  namely,  the  starls 
azimuth  and  elevation  in  the  sensor  field  of  view,  and  roll,  pitch  and 
yaw  of  the  vehicle  relative  to  the  nominal  inertial  reference  frame. 

The  computer  makes  use  of  the  following  successive  transformations  to 
obtain  the  measured  unit  vector  toward  the  star  in  inertial  coordinates: 

STmeas(J)  » [I20]T[02B]T[NB2SI]T[SI2EA]T  STmeas  (c <,^) 

This  unit  vector  Is  stored  for  later  application  in  checking  the  iden- 
tity of  the  star,  and  In  computing  the  amount  of  IRU  misalinement  present. 

Star  Identification  Check  - After  completing  the  "mark"  data  processing 
for  the  first  star,  the  computer  returns  the  IRU  alinement  procedure  to 
a stand-by  status  until  the  second  star  acquisition  can  be  attempted. 
After  the  second  star  appears,  the  acquisition  sighting  and  data  proces- 
sing are  carried  out  in  an  identical  fashion  to  that  used  for  the  first 
star. 

As  a check  upon  the  proper  identification  of  the  two  stars,  the  angle 
between  the  measured  unit  vectors  to  the  two  stars  is  compared  to  the 
angle  computed  using  the  star  catalog  unit  vectors.  This  is  carried 
out  by  the  equations: 

A>ss  =|cos-1  [sT(K)  . STCl^I-Icos-1  (sTmeaa(K)  . STmeas(L)3) 

where  K=  the  star  catalog  number  for  the  first  star 
L=  the  star  catalog  number  for  the  second  star 
^ ^ ss=  star  angle  difference,  in  degrees 
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9. 6. 2.1  IRU  Alignment  (continued) 


Rejection  of  a eet  of  sighting  data  may  he  made  on  the  basis  of  this 
check.  If  0.072  degree,  then  the  data  should  be  rejected.  How- 

ever, if  the  data  is  not  rejected,  it  will  still  not  be  considered  ac- 
ceptable until  a later  check  has  been  made.  Rejection  of  data  at  this 
point  may  be  a result  of  an  erroneous  star  acquisition,  or  may  be  an 
indicator  of  sensor  failure.  It  is  planned  to  implement  logical  test 
sequences  of  the  individual  sensors  with  available  stars  to  determine 
their  performance  whenever  a data  teat  failure  of  the  above  type  occurs. 
These  equations  have  not  yet  been  developed. 

Calculation  of  Gimbal  Torqulng  Angles  - The  procedure  for  determining;;; 
the  angles  through  which  the  gyros  must  be  torqued  for  alinement  is 
based  upon  similar  procedures  used  in  the  Apollo  Guidance  Computer 
(Reference  2).  First,  the  computer  constructs  two  dummy  coordinate 
systems,  one  for  the  star  catalog  unit  vectors  (unprimed  system),  and 
the  other  (primed  system)  set  up  from  the  measured  star  unit  vectors. 


The  primed  coordinate  axes  are  given  by  the  unit  vectors  computed  from: 
Ux  = STmeas(K)  ^ 

U'  _ ^meas(K)  X STmeag(L) 

Js^meas  (K)'  ^ '^meas(u)/ 

Uz  = Ux  X U' 

where:  K and  L are  the  star  catalog  numbers  for  the  first  and  second 

stars,  respectively. 


The  unprimed  coordinate  axes  are  given  similarly  by  the  equations: 

Ux  = S?(K) 

- _ ST(K)  X ST(L) 

Uy  I ST(K)  X Stf(L)| 

Uz  = Ux  X Uy 


The  correct  gyro  torquing  angles  AV'jA£,  and  AV\can  be  found  from  solu- 


of 

the 

general  equation: 

— — . 

Ux 

TH  T12  T13 

Ux 

Uy 

- 

T21  T22  T23 

Uy 

uz 

T31  T32  T33 

uz 

where  the  elements  of  the 


transformation  matrix  are  functions  of  the 


angles  desired.  To  obtain  a unique  solution, an  order  <pf  operation  is 
defined  as  follows:  the  first  rotation  is  about  the  Ux  axis  by  the 

angle  A><to  form  the  Ux,  Uy,  Uz  system.  Then  foU.ows  a rotation  about 
the  new  Uy  axis  by  the  angle  A S to  form  the  Ux,  Uy,  Uz  system.  Last, 
follows  a rotation  about  the  new  Uz  axis  by  the  angle  h'i\to  form  the 


9.6-107 


9.6. 2.1  IRU  Alignment  (continued’) 


uxV>  UyV>  UP  system. 

The  elements  of  the  T matrix  are  given  by  the  following  equations: 


Til 

= cos 

(AX) 

cos 

T12 

= cos 

(An) 

sin 

T13 

=-cos 

(AX) 

sin 

t2i 

a-sin 

(ax) 

cos 

cm 

CM 

EH 

=~sin 

(ax) 

sin 

T23 

= sin 

(Ax) 

sin 

T31 

= sin 

(A  S) 

T32 

=-cos 

(aS) 

sin 

t33 

= cos 

(AS) 

cos 

(AS) 

(b,S)  sin  (A'O  + sin 
US)  cos  (&•/)  + sin 

US) 

(A&  ) sin  (^V)  + cos 
(AS)  cos  (zJY)  + sin 

(A'/) 

(AY) 


(AX)  cos  ( 
(a*0  sin  (/*>\) 

(A>0  cos  (aV) 
(aV)  cos  (AX) 


An  explicit  solution  of  this  set  of  equations  is  required  to  compute 
the  gyro  torquing  angles  AY, , andAX* 


Final  Check  Logic  Equations  - Upon  derivation  of  the  gyro  torquing 
angles,  the  computer  checks  them  against  previous  gyro  drift  rates  to 
determine  their  reasonableness.  If  the  absolute  value  of  all  three  of 
the  torquing  angles  agrees  within  plus  or  minus  0.05  degree  with  the 
absolute  value  of  the  previous  drift  rate  data  point  multiplied  by  the 
elapsed  time  since  the  previous  alinement,  then  the  star  identification 
and  sighting  data  accuracy  is  confirmed.  If  the  agreement  is  different 
by  as  much  as  plu3  or  minus  0.10  degree,  then  the  sighting  data  may  be 
erroneous,  or  the  gyro  drift  rate  may  be  changing,  or  the  stars  may  have 
been  incorrectly  identified.  These  possibilities  should  be  checked  by 
further  sightings  and  calibrations.  Also,  the  cre^r  should  be  notified 
of  a possible  malfunction.  If  the  error  exceeds  + 0.1  degree,  then  the 
star  identification  is  probably  in  error. 


The  equations  for  this  logic  are  as  follows: 


Lets  AXLcheck  - 


If  the  value  of  Aj'lckeck^ 0.05°,  recommend  acceptance. 


If  the  value  of  A.n.ckeck  is  2 0.05°,  but^0.10°,  possible  acceptance, 
but  calibrations  of  gyro  and  tracker  should  be  performed  soon. 
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9. 6. 2.1  IRU  Alignment  (continued) 


If  the  value  of^A  check  is  " 0.10°,  recommend  rejection  and  perform 
calibrations  of  sensor  and  gyros  before  repeating. 


Conclusions  and  Recommendations 


The  equations  which  have  been  described  in  this  report  are  preliminary 
in  form  and  will  be  varied  as  required  to  suit  the  changing  require- 
ments of  the  Shuttle  as  they  develop.  However,  these  equations  are 
considered  acceptable  representations  of  the  IRU  alinement  procedure 
using  the  Multi-Mode  Optical  Sensor. 

Further  expansion  of  the  logic  sections  of  this  procedure  should  be 
made  to  incorporate  sensor  failure  detection  schemes.  These  will 
probably  involve'  some  form  of  in-flight  calibrations  of  each  sensor 
on  a low-priority  basis. 

The  equations  developed  in  this  report  have  been  combined  into  a 
FORTRAN  language  digital  computer  program.  Appendix  B contains  a set 
of  sample  results  obtained  with  this  program.  These  should  be  useful 
as  test  cases  when  these  equations  have  been  integrated  into  a Space 
Shuttle  mission  simulator  program. 
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Figure  2.  Multi-Mode  Optical  Sensor 
Field  of  view  format  in  reacquisition 
mode . 
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+Zt,  North  Celestial  Pole 


Equinox 


Figure'3.  Inertial-to-orbital  plane  coordinate 
transformation  angles . 
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9.6.2. 1 IRU  Alignment  (continued) 


ZSI 


Figure  4.  Coordinate  transformation  from  sensor  "i" 
system  to  elevation/azimuth  system  [SI2EA]. 
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9.6.2. 1 IRU  Alignment  (continued) 


Figure  5.  Earth  Occultation  Test  Geometry 
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APPENDIX  A - STAR  CATALOG 


Catalog 

Number 

Star  Name 

Spectral 

Class 

Direction  Cosines 
X Y ■ Z 

1 

Alpheratz 

+2.15,  AO 

.87513 

.02511 

.48324 

2 

Caph 

+2.42,  F5 

.51542 

.01642 

.85678 

3 

Gamma  Pegasus 

+2.87,  B2 

.96477 

.048l6 

.25864 

4 

Beta  Horologium  +2.90,  GO 

.21608 

.02265 

-.97611 

5 

Ankaa 

+2.44,  A3 

.73309 

. 07885 

-.67554 

6 

Schedar 

+2.47,  KO 

.54637 

.09268 

.83240 

7 

Diphda 

+2.24,  KO 

.93431 

.17246 

- .31198 

8 

Gamma  Cass 

+2.30,  BO 

.47811 

.11607 

.87059 

9 

Mirach 

+2.37,  MO 

.77941 

.23742 

.57979 

10 

Ksora 

+2.80,  A5 

.46641 

.17789 

.86650 

ll 

Achernar 

+0.60,  B5 

.49161 

.21994 

- .84259 

12 

Sheratan 

+2.72,  A5 

.82494 

.44187 

.35246 

13 

Polaris 

+2.12,  F8 

.01359 

.00780 

.99988 

14 

Alrnach 

+2.28,  KO 

.63910 

.37549 

.67124 

15. 

Hamal 

+2.23,  K2 

.78480 

.47714 

.39551 

l6 

Mira 

+2.0OV,  M5E 

.82394 

.56403 

.05470 

17 

Menkar 

+2.82,  m2 

.70405 

. 70680 

.06895 

18 

Algol 

+2.30,  b8 

.52119 

. 54866 

.65371 

19 

Mirfak 

+1.90,  F5 

.4n49 

.49835 

.76310 

20 

Alcyone 

+2.96,  B5P 

. 50622 

.76048 

.40671 

21 

Menkhib 

+2.91,  B1 

.45070 

.72075 

. 52668 

22 

Eper 

+2.96,  B1 

.39650 

.65662 

.64159 

23 

Aldebaran 

+1.06,  GK5 

.35187 

.89224 

.28302 

24 

Has saleh 

+2.90,  K2 

.23540 

.80384 

. 54628 

25 

Cursa 

+2.92,  A3 

.23197 

. 96860 

-.08942 

26 

Rigel 

+0.34,  CB8 

.20215 

.96881 

-.14333 

27 

Capella 

+0.21,  GKO 

.13828 

.68121 

.71891 

28 

Bellatrix 

+1.70,  B2 

.15869 

.98117 

.11007 

29 

Elnath 

+1.78,  B8 

.13708 

.86739 

.47838 
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APPENDIX  A (Cont’d) 


Catalog  Spectral  Direction  Cosines 


Number 

Star  Name 

Class 

X 

Y 

Z 

30 

Nihal 

+2.96,  GO 

' ' L i " J ' ' 

.13518 

.92509 

- .35488 

31 

Mintaka 

+2.48,  BO 

.12959 

.99155 

- .00565 

32 

Arneb 

+2.69,  FO 

.11936 

.94437 

- .30646 

33 

Hatysa 

42.87,  0E5 

.11380 

.98811 

- .10334 

34 

Alnilam 

+1.75,  BO 

.11128 

.99356 

- .02134 

35 

Zeta  Taurus 

+3.00,  B3P 

.09932 

.92751 

.36037 

36 

Fhakt 

+2.75,  B5P 

.07801 

.82446 

- .56052 

37 

Alnitak 

42.05,  BO 

.09148 

.99522 

- .03420 

38 

Saiph 

+2.20,  BO 

.05977 

.98395 

- .16816 

39 

Betelgeuse 

+0.00V,  MO 

.02909 

.99124 

.12883 

4o 

Menkalinan 

42.07,  AOP 

’ .00939 

.70771 

.70644 

4l 

Theta  Auriga 

+2.71,  AOP 

.00927 

.79635 

.60477 

42 

Tejat  Prior 

+3.00V,  MO 

-.05143 

.92232 

.38298 

43 

Mirzam 

+1.99,  B1 

-.08771 

.94734 

- .30797 

44 

Canopus 

-0.86,  FO 

-.06121 

.60322 

-.79522 

45 

Alhena 

+1.93,  AO 

-.14877 

.94756 

.28285 

46 

Sirius 

-1.37,  AO 

-.18118 

.94070 

-.28680 

47 

Tau  Puppis 

+2.83,  KO 

-.13494 

.62060 

-.77243 

48 

Adhara 

+1.63,  B1 

-.21638 

.84810 

-.48364 

49 

Wezen 

+1.98,  F8P 

-.25816 

.85821 

-.44364 

50 

Pi  Puppis 

42.74,  K5 

-.25959 

.75490 

-.60228 

51 

Aludra 

+2.43,  B5P 

-.30813 

.81642 

-.48838 

52 

Castor 

+1.58,  AO 

-.33274 

. 78038 

.52942 

53 

Procyon 

+0.48,  F5 

-.41081 

.90700 

* 09265 

54 

Pollux 

+1.21,  KO 

-.38381 

.794-14 

.47120 

55 

Naos 

42.27,  OD 

-.39036 

.66038 

-.64150 

56 

Rho  Puppis 

42.88,  F5 

-.47675 

.77758 

-.40996 

57 

Gamma  Velorum 

+1.90,  00 

-.36097 

.57513 

-.73412 

58 

Avior 

+1.74,  KO 

-.29527 

.41472 

-.86071 

59 

Delta  Velorum 

+2.01,  AO 

-.37973 

.43784 

-.81492 

6o 

Suhail 

+2.22,  K5 

-.52953 

.49941 

-.68570 

6l 

Miaplacidus 

+1.80,  AO 

-.26021 

.23260 

-.93712 
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Catalog 

Number 

Star  Name 

Spectral 

Class 

X 

Direction 

Y 

Cosines 

Z 

62 

Tureis 

+2.25,  FO 

-.38748 

.33638 

-.85832 

63 

Kappa  Velorum 

+2.63,  B3 

-.44256 

.36798 

-.81776 

64 

Alphard 

+2.16,  K2 

-.77364 

.61612 

-.14791 

65 

Vel 

+3.00,  K5 

-.43372 

.33233 

-.83752 

66 

Regulus 

+1.34,  B8 

-.86020 

.46458 

.21028 

67 

Algieba 

+2.61,  K0 

-.84813 

.40433 

.34233 

68 

Mu  Velorum 

+2.84,  G5 

-.61855 

.20919 

-.75739 

69 

Merak 

+2.44,  AO 

-.53198 

.14319 

.83456 

70 

Dubhe 

+1.95,  K0 

-.45519 

.11860 

.88246 

71 

Zosma 

+2.58,  A3 

-.91512 

.19347 

.35373 

72 

Denebola 

+2.23,  A2 

-.96548 

.05366 

.25490 

73 

Fhecda 

+2.54,  AO 

-.58899 

.02058 

.80788 

74 

Delta  Centauri 

42.88,  B3P 

-.63545 

-.01813 

-.77193 

75 

Gienah 

+2.78,  B8 

-.95273 

-.05829 

-.29817 

76 

Acrux 

+1.00,  B1 

-.45283 

-.04887 

-.89025 

77 

Gamma  Acrux 

+1.61,  M3 

-.54142 

-.06939 

-.83789 

78 

Kraz 

+2.84,  G5 

-.90986 

-.13008 

-.39400 

79 

Alpha  Muscis 

+2.94,  B3 

-.35510 

-.05478 

-.93322 

80 

Gamma  Centauri 

+2.38,  AO 

-.64931 

-.11326 

-.75204 

81 

Ar  ich 

+2.91,  FO 

- . 98466 

-.17311 

-.02195 

82 

Beta  Crucis 

+1.50,  B1 

-.49753 

-.10046 

-.86161 

83 

Alioth 

+1.68,  AOP 

-.54248 

-.12648 

.83049 

84 

Chara 

+2.90,  AOP 

-.76060 

-.18399 

.62261 

85 

Vindemiatrix 

+2.95,  KO 

-.94722 

-.25573 

.19333 

86 

Icen 

+2.91,  A2 

-.75674 

-.27029 

-.59522 

87 

Mizar 

+2.40,  A2P 

-.53536 

-.20155 

.82023 

88 

Spica 

+1.21,  B2 

-.91749 

-.34919 

-.19045 

89 

Hya 

+3.00V,  M7E 

-.85314 

-.34381 

-.39236 

90 

Epsilon  Centaur i+2 .56,  B1 

-.54432 

-.24708 

- . 80166 

91 

Alkaid 

+1.91,  B3 

-.58115 

-.29027 

.76026 

92 

Mufrid 

+2.80,  GO 

-.83498 

-.44873 

.31850 

93 

Beta  Centauri 

+0.86,  B1 

-.42887 

-.25095 

-.86781 
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Catalog 

Number 

Star  Name 

Spectral 

Class 

Direction  Cosines 
X Y Z 

94 

Menkent 

+2.26,  KD 

-.69059  -.41748 

-.59059 

95 

Arc turns 

+0.24,  GKO 

-.78697  -.52093 

.33157 

96 

Haris 

+3.00,  FO 

-.61983  -.47849 

.62198 

97 

Eta  Centauri 

+2.65,  B3P 

-.58301  -.46074 

-.66920 

98 

Alpha  Centauri 

+0.06,  GO 

-.37878  -.31005 

-.87200 

99 

Alpha  Lupus 

+2.89,  B2 

-.52087  -.43549 

-.73419 

100 

Izar 

+2.70,  KO 

-.67250  -.58181 

.45742 

101 

Zuben  A 

+2.90,  A3 

-.71208  -.64646 

-.27392 

102 

Kochab 

+2.24,  K5 

-.19890  -.18351 

. 96269 

103 

Beta  Lupus 

42.81,  B2P 

-.52563  -.50862 

-.68193 

io4 

Zuben  B 

42.74,  b8 

-.65037  -.74239 

-.16083 

105 

Gamma  Lupus 

+2.95,  B3 

-.45174  -.60386 

-.65672 

106 

Alphecca 

+2.31,  AO 

-.53327  -.71547 

.45137 

107 

Cor  Serpentis 

42.75,  KO 

-.56079  -.82010 

.11380 

108 

Pi  Scorpii 

+3.00,  B2 

-,46o4o  -.77179 

-.43860 

109 

Dschubba 

+2.54,  BO 

-.46792  -.79644 

-.38306 

no 

A crab 

+2.90,  B1 

-.45856  -.82217 

-.33728 

ill 

Sigma  Scorpii 

+2.87,  B1 

-.38478  -.81637 

-.43068 

112 

Eta  Draconis 

+2.89,  G5 

-.19442  -.43419 

.87959 

113 

Antares 

+1.22,  GKO 

-.35279  -.82368 

-.44395 

114 

Kornephoros 

+2.81,  KO 

-.36071  -.85720 

.36755 

115 

Tau  Scorpii 

+2.91,  BO 

-.32424  -.81998 

-.47170 

116 

Zeta  Ophiuchi 

+2.70,  BO 

-.35546  -.91676 

-.18220 

117 

Zeta  Herculis 

+3.00,  GO 

-.29123  -.79976 

.52495 

118 

Atria 

+1.88,  K2 

-.n546  -.33984 

-.93337 

119 

Epsilon  Scorpii  +2.36,  KO 

-.25586  -.78619 

-.56254 

120 

Sabik 

42.63,  A2 

-.21507  -.93844 

-.27032 

121 

Beta  Ara 

+2.80,  K2 

-.09255  -.55881 

-.82412 

122 

Upsilon  Scorpii  +2.80,  B3 

-.10944  -.78823 

-.60557 

123 

Alpha  Ara 

+2.97,  B3P 

-.08658  -.63894 

-.76437 

124 

Aiwa id 

+2.99,  GO 

-.08072  -.60581 

.79151 

125 

Shaula 

+1*71,  B2. 

-.09988  -.79151 

-.60293 
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APPENDIX  A (Cont'd) 

Catalog  Spectral  Direction  Cosines 


Number 

Star  Name 

Class 

X 

Y 

Z 

126 

Rasalhague 

+2.14,  A5 

-.11341 

-.96937 

.21787 

127 

Theta  Scorpii 

+2.04,  F0 

-.08028 

-.72720 

-.68171 

128 

Kappa  Scorpii 

+2.51,  B2 

-.06750 

-.77406 

-.62951 

129 

Kelb-Alrai 

+2.94,  K0 

-.07933 

-.99364 

.07986 

130 

Eltanin 

+2.42,  K5 

-.01143 

-.62252 

.78252 

131 

Kaus  Medius 

+2.84,  K0 

.07090 

-.86447 

-.49766 

132 

Kaus-Australis 

+1.95,  AO 

.07854 

-.82134 

-.56501 

133 

Kaus-Bor. 

+2.94,  K0 

.10148 

-.89729 

-.42961 

134 

Vega 

+0.14,  AO 

.12117 

-.77041 

.62592 

135 

Nunki 

+2.14,  B3 

.20576 

-.87222 

-.44373 

136 

Ascella 

+2.71,  A2 

.22570 

-.83671 

-.49897 

137 

Delta  Cygni 

+2.97,  AO 

.30940 

-.63521 

.70766 

138 

Re  da 

+2.80,  K2 

.43329 

-.88254 

.18269 

139 

Altair 

+0.89,  A5 

.45280 

-.87846 

.15255 

l4o 

Eta  Aquila 

+3.00V,  GOP 

.46436 

-.88550 

.01596 

l4i 

Sador 

+2.32,  f8p 

.44111 

-.62432 

.64471 

142 

Peacock 

+2.12,  B3 

.31928 

-.44396 

-.83723 

143 

Deneb  Cygni 

+1.33,  A2 

.45385 

-.53974 

. 70901 

144 

Gienah 

+2.64,  K0 

.54710 

-.62498 

.55685 

145 

Alderamin 

+2.60,  A5 

.35152 

-.30091 

.88650 

146 

Enif 

+2.54,  KO 

.81344 

-.55663 

.16872 

147 

Deneb  Algiedi 

+2.98,  A5 

.79836 

-.53289 

-.28045 

148 

Naquir 

;*2ol6,  B5 

.59793 

-.32453 

-.73292 

149 

Alpha  Tucanae 

+2.91,  K2 

.44359 

-.21607 

-.86980 

150 

Beta  Grus 

+2.24,  M3 

.64064 

-.23132 

-.73217 

151 

Formalhaut 

+1.29,  A3 

.83379 

-.24019 

-.49710 

152 

Scheat 

+2.61,  MO 

.85575 

-.22102 

.46781 

153 

Markab 

+2.57,  AO 

.93615 

-.23768 

.25910 
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APPENDIX  B 
TEST  RESULTS 


Introduction 

The  computer  program,  which  has  been  developed  from  the  equations  derived 
in  the  report,  is  intended  to  serve  two  purposes.  First,  it  is  to  be  sub- 
mitted formally  as  a baseline  equations  document  for  use  in  on-board  com- 
puter simulation  studies.  Secondly,  it  will  be  used  to  provide  solutions 
to  technical  problems  encountered  in  the  development  of  the  MMOS  itself. 
This  appendix  is  primarily  to  provide  a summary  of  typical  results  for 
specified  test  cases  which  can  be  used  to  check  the  performance  of  the 
submitted  program  after  it  has  been  incorporated  into  a much  larger  on- 
board computer  simulation  program.  However,  a few  results  have  been  in- 
cluded which  may  be  of  interest  principally  to  those  involved  in  the  hard- 
ware development  task. 

Task  Method 

Locations  for  three  sensors  were  hypothesized  as  shown  in  Table  B-l.  The 
orientations  may  be  visualized  simply  as  three  equally- spaced  directions 
in  the  X-Y  plane  (yaw  plane)  of  the  body  coordinate  system.  Sensor  num- 
ber 1 looks  along  the  +X  axis,  sensor  number  2 looks  behind  the  right  wing, 
and  sensor  number  3 looks  behind  the  left  wing  of  the  vehicle. 


Table  B-l.  Sensor  Locations 


Sensor  Number 

1 

X 

1 

0° 

0° 

0° 

2 

0° 

0° 

120° 

3 

0° 

0° 

o 

o 

-=r 

OJ 

Six  possible  orbit  conditions  were  assumed  to  provide  fairly  complete 
utilization  of  the  star  catalog.  The  coordinate  angles  for  these  condi- 
tions are  shown  in  Table  B-2. 
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Table  B-2.  Orbit  Conditions 


Longitude  of  the 

Orbit 

Ascending  Node 

Inclination 

Name 

. . 

Ecliptic 

0° 

33° 

GAlactic 

281° 

62° 

Equatorial 

0° 

0° 

Perpendicular  to  Ecliptic 

l8o° 

67° 

Perpendicular  to  Galactic 

101° 

28° 

Perpendicular  to  Equatorial  0° 

90° 

In  the  orbital  plane,  the  orbital  angular  velocity^  was  set  at  O.O67 
degrees  per  second  to  correspond  to  an  altitude  H of  270  nautical  miles. 
The  sun  and  the  moon  were  assigned  arbitrary  locations  at  opposite  sides 
of  the  celestial  sphere  at  the  intersections  between  the  ecliptic  plane 
and  the  galactic  plane.  In  this  way,  maximum  interference  with  catalog 
stars  was  obtained.  Table  B-3  contains  the  sun  and  moon  location  data 
that  was  used. 


Table  B-3.  Sun  and  Moon  Unit  Vectors 

X Y Z 

Sun  0.000  0.906  0.423 

Moon  0.000  -0.906  -0.423 

At  the  beginning  of  each  simulated  orbit,  the  vehicle  was  oriented  in  a 
wings  level,  "heads  up"  attitude,  with  the  +X  axis  directed  along  the 
forward  velocity  vector.  The  angular  rotations  required  to  obtain  this 
attitude  (referenced  to  the  orbital  plane  system)  are  given  in  Table  B -4 
An  attitude-hold  mode  about  the  nominal  attitude  was  also  established. 
The  angular  deadband  limits  were  set  at  plus  and  minus  5 degrees,  with 
the  angular  velocities  as  given  in  Table  B -4. 
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Table  B-U,  Vehicle  Attitude  and  Angular  gfelocitles 

Axis  Attitude  (Degrees)  Angular  Velocity  (Degrees/Second) 

Roll  -90  0.012 

Pitch  -90  0.008 

Yaw  0 0.170 

During  simulated  orbit,  the  program  carries  out  the  state  vector  update, 
.and  the  star  search  and  selection  processes  at  one-half  minute  time  in- 
tervals. At  each  time  point,  the  vehicle's  position  vector  in  the  iner- 
tial coordinate  system,  and  the  unit  vectors  for  the  center  line-of- 
signt  of  each  sensor  are  printed  out.  Whenever  the  star  selection  is 
completed  successfully,  the  catalog  numbers  of  the  selected  stars,  and 
the  numbers  of  the  usable  sensors  also  are  given.  Also  given  are  the 
times  at  which  each  star  will  be  available,  and  the  expected  star  sepa- 
ration angle. 

In  order  to  represent  the  more  important  aspects  of  this  output  data, 
the  format  shown  in  Figures  B-l  through B. ^6  has  been  selected.  The  orbi- 
tal time  in  ihinutes  is  displayed  along  the  horizontal  axis.  In  the  upper 
graph,  the  possibility  of  performing  an  immediate  IRU  alinement  is  indi- 
cated by  a raised  section  of  the  curve.  If  the  alinement  cannot  be  ac- 
complished at  that  moment,  the  curve  is  lowered  until  a later  trial  gives 
a positive  result. 

When  the  upper  curve  has  its  lower  value,  the  solution  may  consist  of 
inhibiting  the  attitude  hold  mode  and  waiting  until  two  stars  can  be  ac- 
quired. A maximum  time  of  ten  minutes  has  been  arbitrarily  allowed  for 
this  inhibit  process.  The  lower  curve  indicates  the  magnitude  of  the 
delay  in  minutes  (after  the  current  time)  before  the  second  star  could 
be  acquired.  In  the.  results  Illustrated  In  these  six  cases,  there  were 
no  instances  in  which  the  delay  exceeded  the  ten  minutes  allowed. 

The  figures  have  been  arranged  in  a sequence  of  increasing  percentage 
of  immediate  alinements.  The  orbit  about  the  north  galactic  pole  was 
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the  worst  case.  After  about  seven  minutes,  the  forward-looking  sensor 
experienced  sun  interference  and  was  not  usable  again  until  about  22 
minutes  elapsed  time.  During  that  interval,  the  other  two  sensors  could 
have  provided  an  alinement  capability  if  the  thrusters  had  been  inhibited 
for  as  long  as  three  minutes.  In  the  period  from  about  25  minutes  until 
aboug  35  minutes,  the  forward-looking  sensor  was  passing  through  the 
sparsely-populated  region  around  the  north  celestial  pole,  although  the 
other  two  sensors  were  capable  of  providing  the  alinement  if  an  inhibit 
time  of  one  or  two  minutes  could  be  accepted.  In  the  ten-minute  inter- 
val beginning  at  56  minutes  elapsed  time,  the  forward-looking  sensor  is 
having  some  interference  from  the  moon.  Then,  after  a brief  period  of 
alinement  capability,  the  same  sensor  passes  into  a low-density  region 
near  the  south  celestial  pole.  However,  as  the  spacecraft  again  approaches 
the  initial  orbit  position,  the  capability  for  immediate  alinement  is  also 
regained. 

The  point  of  maximum  delay  time  was  reached  at  62  minutes  elapsed  time. 

A delay  of  six  minutes  was  predicted;  however,  an  immediate  alinement  was 
found  to  be  possible  four  minutes  later,  using  an  entirely  different  pair 
of  stars  and  sensors.  This  type  of  occurrence  is  highly  typical  for  the 
three-sensor  mode  of  operation  in  all  of  the  conditions  tested  so  far. 
Further  tests  will  be  necessary  to  determine  an  optimum  balance  between 
the  maximum  allowable  delay  time  and  the  percentage  of  trials  in  which 
thruster  inhibit  is  required.  For  this  set  of  conditions,  a maximum  de- 
lay time  of  ten  minutes  resulted  in  a worst-case  percentage  of  about  67 
percent  for  the  thruster  inhibit  condition.  This  is  also  a function  of 
the  field  of  view  size  as  will  be  illustrated  next. 

Figure B -7  presents  the  results  of  reducing  the  field  of  view  radius  from 
8.5  degrees  to  5.0  degrees.  The  orbit  perpendicular  to  the  ecliptic  plane 
as  shown  in  Figure B -2  was  selected  for  this  test.  The  vertical  axis  on 
the  left  side  of  the  figure  shows  the  180  time  points  during  the  orbit  at 
which  the  star  selection  process  was  initiated.  The  horizontal  axis  is 
approximately  proportional  to  the  field  of  view  area  indicated  by  the 
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9.6.2. 1 IRU  Alignment  (continued) 


square  of  the  angular  radius.  These  results  indicate  that  the  percentage 
of  immediate  alinements  can  be  fairly  accurately  estimated  for  any  rea- 
sonable sensor  field  of  view,  if  the  perforaance  at  one  field  size  is 
known  for  the  desired  orbital  condition.  If  this  indication  proves  valid 
in  further  tests,  a considerable  number  of  computer  runs  can  be  eliminated. 
Another  interesting  fact  to  be  obtained  from  this  graph  is  that  the  ave- 
rage delay  time  1h  completing  the  alinement  increases  more  rapidly  than 
the  inverse  square  relationship  anticipated  from  the  field  of  view  area 
reduction.  The  trade-off  between  the  number  of  active  Bensors  and  the 
field  of  view  size  required  will  be  very  dependent  upon  the  maximum  de- 
lay time  allowed  for  the  thruster  inhibit. 
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Figure  B-l.  Alinement  possibility  and  delay  time  results 
for  an  orbit  .about  the  north  galactic  pole.  Immediate  a- 
linement  was  possible  in  33.2  percent  of  the  trials. 
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9.6.2. 1 
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Figure  B-2.  Alinement  possibility  and  delay  time  re- 
sults for  an  orbit  perpendicular  to  the  ecliptic  plane. 
Immediate  alinement  was  possible  in  42.2  percent  of  the 
trials . 
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9.6.2. 1 IRU  Alignment  (continued) 
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Figure  B-3.  Alinement  possibility  and  delay  time  re- 
sults for  an  orbit  perpendicular  to  the  galactic  plane. 
Immediate  alinement  was  possible  in  49.4  percent  of  the 
trials. 
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Figure  B-1+.  Alinement  possibility  and  delay  time 
results  for  an  orbit  in  the  equatorial  plane.  Im- 
mediate alinement  was  possible  in  52.7  percent  of 
the  trials. 
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Figure  B -5.  Alinement  possibility  and  delay  time  results 
for  an  orbit  perpendicular  to  the  equatorial  plane.  Imme- 
diate alinement  was  possible  in  59.5  percent  of  the  trials. 
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9.6.2. 1 IRU  Alignment  (continued) 


Figure B -6.  Alinement  possibility  and  delay  time  re- 
sults, for  an  orbit  in  the  ecliptic  plane.  Immediate 
alinement  was  possible  in  59.5  percent  of  the  trials* 
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9.6.2. 1 IRU  Alignment  ( continued 


Field  of  View  Radius  (Deg) 


Figure  3-7  • Field  of  view  size  effects  upon  the  capa- 
bility to  aline  with  3 sensors  separated  by  120  degrees 
in  the  yaw  plane.  The  orbit  is  perpendicular  to  the 
ecliptic . 
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9.7  ORBITAL  POWERED  FLIGHT 


The  following  GN&C  software  functions  are  envisioned  for  the  orbital 
phase : 

Guidance  Functions 

1.  Perforin  orbit  modifications  targeting,  or  accept  ground/ 
base  targeting  solutions  as  initialization. 

2.  Compute  and  command  initial  thrusting  attitude. 

3.  Command  orbiter  maneuvering  engine  on. 

4.  Compute  velocity  to  be  gained  vector  (before  and  during 
bum) . 

5.  Provide  orbit  maneuver  steering  commands  to  autopilot. 

6.  Compute  time-to-cut-of f and  issue  engine  off  commands. 

7.  Provide  commands  to  null  residual  velocities. 

Navigation  Functions 

1.  Specific  Force  Integration  - Advance  the  inertial  state 
utilizing  accelerometer  measurement  of  thrust  and 
aerodynamic  forces. 

2.  Update  inertial  state  from  other  navigation  sensor  data 
if  available.  An  example  is  radar  altimeter  data. 

3.  Provide  coordinate  transformations  for  state  vectors 
as  required . 

4.  Compare  state  with  that  calculated  by  other  vehicle 
during  launch  for  use  in  decision  making  and  possible 
updating . 

Control  Functions 

1.  Perform  vehicle  stabilization  and  control  during  TVC  by 
engine  gimbal  commands. 

2.  Provide  vehicle  roll  stabilization  during  single-engine 
burns  using  RCS. 

3.  Perform  attitude-hold  RCS  AV  maneuvers. 

4.  Perform  steered-attitude  RCS  AV  maneuvers  for  docking 
if  required. 
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5.  Do  eg/ trim  estimation  during  TVC  burns. 

6.  Make  high-frequency  steering  estimates  between  guidance 
samples  for  docking  if  required. 

7.  Perform  adaptive-loop  gain  calculation  if  required. 
9.7.1  Required  Velocity  Determination 
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9. 7. 7.1  REQUIRED  TELOCITY  DETERMINATION.  CONIC 


SPACE  SHUTTLE 

GN&C  SOFTWARE  EQUATION  SUBMITTAL 

Software  Equation  Section:  Required  Velocity  Determination  (Conic) 


Submittal  No.  2AA 


Function:  Solution  of  Multi-Revolution  Lambert's  and  De-Orbit  Problems 


Module  No.  0G5 
0G2 


Function  No.  1,2  (MSC  03690) 

4 

1.2 »3_ 


Submitted  byL  W,  M,  Robertson  Co.  MIT  No.  10  (Rev.  1) 


Date:  21  October  1971 

NASA  Contract:  J.  Suddath Organization:  EG2 

Approved  by  Panel  III:  Date:  lo/%i jm 

Summary  Description:  Computes  velocity  vector  required  at  an  initial 

position  to  transfer  through  an  inverse  square  central  force  field  from 
the  initial  position  (l)  to  a specified  target  position  in  a specified 
time  interval  or  (2)  to  a specified  (lower)  target  radius  with  a speci- 
fied flight-path  angle  in  a specified  transfer  time  interval.  Revision 
includes  logic  (1)  to  preclude  difficulties  for  transfer  angles  near  I80g 
and  (2)  to  improve  Secant  Iterator. 

Shuttle  Configuration:  This  software  is  essentially  independent  of  shuttle 

configuration. 


Comments: 


(Design  Status)  

(Verification  Status) 
Panel  Comments: 


Revision:  A.  Prior  Submittal  July  1971. 
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9. 7. 1.1  Conic  (continued) 


1.  INTRODUCTION 

The  Conic  Required  Velocity  Determination  Routine  provides 
the  capability  to  solve  the  following  two  astrodynamic  problems: 

"The  Multiple- Revolution  Lambert  Required  Velocity  Determination 
Problem":  compute  the  velocity  vector  required  at  an  initial  posi- 
tion to  transfer  through  an  inverse  square  central  force  field  from 
the  initial  position  to  a specified  target  position  in  a specified 
transfer  time  interval  by  making  a specified  number  of  complete 
revolutions  (plus  some  fraction  of  another  one).  Also  optionally 
compute  the  velocity  vector  at  the  target  position  and  various 
parameters  of  the  conic  transfer  orbit. 

"The  De-orbit  Required  Velocity  Determination  Problem":  compute 
the  velocity  vector  required  at  an  initial  position  to  transfer  through 
an  inverse  square  central  force  field  from  the  initial  position  to  a 
specified  target  radius  (which  is  less  than  the  initial  radius)  with  a 
specified  flight-path  angle  at  that  radius  in  a specified  transfer  time 
interval.  Also  optionally  compute  the  velocity  vector  at  the  target 
position  and  various  parameters  of  the  conic  transfer  orbit. 
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9.7.1.1 


NOMENCLATURE 


a Semi- major  axis  of  conic 

Cj  First  conic  parameter  [ c^  ~~\fr  0 PN  r0  = (£q  ' v-0>/^  E J 

2 

C2  Second  conic  parameter  [ Cg  = 1 -0^  = ro  v0  / ^E  ^ 

C or  C(£)  Power  series  in  defined  in  the  text 

E Eccentric  anomaly 

f True  anomaly 

H Hyperbolic  analog  of  eccentric  anomaly 

i Iteration  counter 

_L_  The  negative  unit  chord  vector  connecting  rQ  and 

r 1 . [ j_c_  = -unit  (r  j - rQ)]  . 

Maximum  allowable  number  of  iterations 

Unit  vector  in  direction  of  angular  momentum 

vector  of  the  transfer  and  normal  to  the  transfer 

plane.  In  the  Lambert  Foutine  the  vector 

always  determines  the  direction  of  the  transfer, 

and  will  also  determine  the  plane  of  the  transfer 

when  either  the  switch  s . = 1,  or  the  switch 

P 

s . = 0 but  the  initial  position  vector  r„  is 
pro]  r —0 

inside  one  of  the  cones.  In  the  De-orbit  Routine, 
the  vector  _i  ^ always  determines  the  plane  and 
direction  of  the  transfer. 

Unit  vector  in  direction  of  £q 
Unit  vector  in  direction  of  £ ^ 
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9. 7. 1.1  Conic-  (cofttinued) 


k 


k 


bg 


k 


sm 


m 


m 


m 


err 


n 

n 

rev 


N 

P 

Pi 


P2 


PN 


q 


Intermediate  variable  equal  to  either  k,  _ or  k 

^ bg  sm 

Constant  establishing  by  what  fraction  of  its  permissible 

range  (P  - T ) the  independent  variable  17  will 
6 •‘•max  min  0 

be  biased  in  the  first  iteration  when  no  guess  P is 

f guess 

available,  in  order  to  establish  a second  point  for  the 
secant  iteration 

Constant  establishing  by  what  fraction  of  its  permissible 

range  (1^,^  - ) the  independent  variable  Tg  will 

be  biased  in  the  first  iteration  when  a guess  P is 

H ■‘guess 

available  in  order  to  establish  a second  point  for  the 
secant  iteration. 

The  slope  of  the  line  joining  two  successive  points  on  the 
transfer  time  interval  vs.  independent  variable  curve. 

Previous  value  of  m 

Difference  between  desired  value  of  the  slope  m (namely 
zero)  and  the  value  calculated  on  most  recent  iteration. 

Loop  counter  in  the  Marscher  Equation  Inversion 

Integer  number  of  complete  360°  revolutions  to  be 

made  in  the  desired  transfer.  [Hence  the  transfer 

will  be  between  n and  n +1  revolutions]. 

rev  rev  ' 


Intermediate  vector  variable  normal  to  transfer  plane 
Semi-latus  rectum  of  conic 

Intermediate  variable  in  the  Lambert  problem  equal 
to  1 - cos  8 

Intermediate  variable  in  the  Lambert  problem  equal 
to  cos  0 - (rQ  / rj  ) 

Normalized  semi-latus  rectum  of  conic  transfer  orbit 

<PN  = P / r 0 >■ 

Intermediate  variable  equal  to  X/sin 
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9. 7.1.1.  Conic  (oontinued) 


Initial  or  current  inertial  position  vector  (corresponds 
to  time  t g ) . 

r Terminal  or  target  inertial  position  vector  (corresponds 

to  time  t ^ ). 

r Radius  at  terminal  or  target  position  (corresponds 

to  time  t ^ ). 

s Switch  used  in  Secant  Iterator  to  determine  whether 

secant  method  or  offsetting  (biasing)  will  be  performed. 

s Switch  indicating  whether  the  outcome  of  the  cone  test 

cone 

involving  the  tolerance  criterion  econe  was  that  initial 

position  r Q lies  outside  both  of  the  cones  around  the 

positive  and  negative  target  position  vector  r (scone  = 

0),  or  inside  one  of  these  cones  (s  = 1 ).  [See 

cone 

Section  4.7.] 


s Switch  indicating  whether  the  routine  is  to  compute  its  own 

guess  ° ... 

guess  of  the  independent  variable  JTq  to  start  the  iterative 

procedure  (s  = 0),  or  is  to  use  a guess  T 

b guess  b guess 

supplied  by  the  user  (Sguess  = D 

s Switch  indicating  whether  the  initial  and  target  position 

proj 

vectors,  and  r ^ , are  to  be  projected  into  the  plane 

defined  by  the  unit  normal  _i  ^ before  the  main  Lambert 

computations  are  performed.  If  s = no  projection 

will  be  made  unless  the  initial  position  £q  is  found  to 

lie  within  one  of  the  cones  defined  by  ccone  * in  which  case 

s will  be  set  equal  to  1.  If  s = 1,  the  projections 
cone  n proj  J . f/ 

will  be  carried  out  immediately,  and  no  cone  test  will  . 

be  made. 
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9. 7. 1.1  Cflnia  ('continued') 


’ soln 


Switch  indicating  which  of  the  two  physically  possible 
solutions  is  desired  in  the  multi-revolution  case. 

[ Not  used  in  the  less-than- 360°  transfer  case]  . In 
particular,  ssojn  = "I  indicates  the  solution  with  the 
smaller  initial  flight  path  angle  Y Q measured  from 
local  vertical,  and  s s0^n  = indicates  the  one  with 
the  larger  YQ  . 


: Switch  indicating  whether  the  central  transfer  angle 

180  no  o 

is  between  0 and  180  (s^q  = +^’  or  '3eIween  180 

and  360°  (s1ori  = -1).  The  determination  of  which 
180 

one  of  the  above  two  possibilities  is  desired  is  made 
automatically  by  the  routine  on  the  basis  of  the  di- 
rection of  the  unit  normal  vector  _i  . 

[In  the  multiple-revolution  case,  the  number  of  com- 
plete 360°  revolutions  is  neglected:  i.  e.  , s18Q  is  the 
sign  of  the  sine  of  the  transfer  angle.  ] 


S orS(£)  Power  series  in  £ defined  in  the  text. 


err 


Difference  between  specified  time  interval  and  that 

calculated  by  Universal  Kepler  Equation  [ terr 

At  - At  ] 
c J 


Inertial  velocity  required  at  the  initial  position  rQ 
to  transfer  to  the  terminal  point  in  exactly  the 
specified  time  interval  At. 


-1 


Inertial  velocity  at  the  terminal  position  r ^ 


Vn  Intermediate  scalar  variables  used  in  Marscher  Equa 


(n-1, 2. . ) tion  Inversi 


ion 


Intermediate  scalar  variables  used  in  Marscher  Equa 


(n-1,  2.  . ) tion  Inversi 


ion 
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x 


XN 

“N 


Universal  eccentric  anomaly  difference  corresponding 
to  the  transfer  from  r g to  r ^ . 

Normalized  universal  eccentric  anomaly  difference 

(xN  = x/V^) 

Reciprocal  of  normalized  semi- major  axis  of  conic 
transfer  orbit  (a^  = rg  / a). 

Flight  path  angle  at  initial  position  £q  measured 
from  local  vertical,  i.  e.  , angle  from  £q  to  Vq  . 


y Flight- path  angle  at  terminal  or  target  position 

measured  from  local  vertical  (corresponds  to 
time  t ^ )’. 

Fq  Cotangent  of  flight-path  angle  y Q at  the  initial  posi- 

tion £g  measured  from  local  vertical;  i.e., 
cotangent  of  the  angle  between  £Q  and  vQ.  [In- 
dependent variable  in  iterative  scheme]  . 

t _ 

Xq  Previous  value  of  Iq 

1^*^  The  "i-th"  value  of  Tq 

rx  Cotangent  of  flight  path  angle  at  the  terminal 

or  target  position  r ^ measured  from  local 
vertical 

F ess  Guess  of  independent  variable  Tq  corresponding 
to  solution  (disregarded  when  SgUess  = 0). 


parab 

Value  of  rQ 

corresponding  to  the  physically 

realizable  parabolic  transfer 

r 

max 

Upper  bound 

on  ro 

*ME 

Value  of  r0 

corresponding  to  the  minimum  energy 

transfer 

• . ■ 
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9. 7. 1.1  Conic  ( continued) 


T . Lower  bound  on  II 

■“•min  u 

At  Specified  transfer  time  interval  (t^  - t^)  between  r^ 

and  r ^ 


At 


c 


At 


c 


Value  of  the  transfer  time  interval  calculated  in  the 
Universal  Kepler  Equation  from  the  current  value 
of  1^  and  the  conic  parameters 

Previous  value  of  Atc 


At  ^ The  "i-th"  value  of  the  transfer  time  interval  cal- 

c 

culated  in  the  Universal  Kepler  Equation  as  a 
function  of  the  "i-th"  value  11^  of  Iq  and  fhe 
conic  parameters 


*ro  Increment  in  Tg 

AA  Increment  in  A 


e Tolerance  criterion  establishing  small  cones  around 

cone 

both  the  positive  and  negative  target  position  direc- 
tions inside  of  which  the  Lambert  routine  will  define 
the  plane  of  the  transfer  by  the  unit  normal 
rather  than  the  cross  product  of  the  initial  and  target 
position  vectors,  and  r ^ . [ econe  = sin  (^e  half 

cone  angle  ) ] . 


e t Primary  convergence  criterion:  relative  error  in 

transfer  time  interval 

et'  Secondary  convergence  criterion:  minimum  permissible 

difference  of  two  successive  calculated  transfer  time  in- 
tervals. 


Convergence  criterion  in  iteration  to  adjust  1”^ -n 

and  r in  multiple  revolution  case:  absolute 

max 

precision  to  which  transfer  time  interval  minimum 
is  to  be  determined 

Tertiary  convergence  criterion:  minimum  per- 
missible size  of  increment  Al^  of  the  independent 
variable 
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e.  Tolerance  criterion  in  iteration  to  adjust  P . and 

A J min 

P in  multiple  revolution  case:  absolute  dif- 
max 

ference  of  two  successive  values  of  independent  vari 
able  to  prevent  division  by  zero 

® Transfer  angle  (true  anomaly  increment) 

X Ratio  of  initial  position  radius  to  terminal  position 

radius 

A Average  of  the  two  most  recent  values  of  . [A 

is  used  as  the  independent  variable  in  the  Multi- 
revolution Bounds  Adjustment  Coding  Sequence 
Iteration]  . 

A'  Previous  value  of  A 

V Gravitational  parameter  of  the  earth  (product  of 

earth's  mass  and  universal  gravitation  constant) 

£ The  dimensionless  variable  ox2  '=  x2  / a = aN  x2  / 

rg  . . [ Equivalent  to  square  of  standard  eccentric 
or  hyperbolic  anomaly  difference]  . 
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9. 7. 1.1  Conic  (continued) 


2.  FUNCTIONAL  FLOW  DIAGRAM 

The  Conic  Required  Velocity  Determination  Routine  basically  consists  of  two 
major  parts— one  for  solving  the  multi-revolution  Lambert's  problem  and  one  for 
solving  the  De-orbit  problem  — which  are  quite  similar.  In  fact,  certain  subsections 
of  the  parts  are  identical  as  well  as  being  identical  to  certain  subsections  of  the 
Conic  State  Extrapolation  Routine  (Ref.  7)  and  these  may  of  course  be  arranged  as 
subroutines  on  a computer. 

The  Conic  Lambert  and  De-orbit  Required  Velocity  Determination  Routines 
each  involve  a single  loop  iterative  procedure,  and  hence  are  organized  in  three 
sections:  initialization,  iteration,  and  final  computations,  as  shown  in  Figure  1. 

The  independent  variable  in  the  iteration  in  both  routines  is  the  cotangent  of  the 
flight-path  angle  at  the  initial  position  measured  from  local  vertical,  or  equiva- 
lently the  cotangent  of  the  angle  between  the  initial  position  vector  (extended)  and 
the  as  yet  unknown  required  velocity  vector.  The  dependent  variable  is  the  trans- 
fer time  interval;  it  is  a function  solely  of  the  independent  variable  and  certain 
other  quantities  which  depend  explicitly  on  the  input  and  which  are  thus  constant  in 
any  one  problem.  In  the  iterative  procedure,  the  independent  variable  (denoted  by 
F0)  is  adjusted  between  upper  and  lower  bounds  by  a secant  technique  until  the 
transfer  time  interval  computed  from  it  agrees  with  the  specified  transfer  time  in- 
terval (to  within  a certain  tolerance).  Then  the  velocity  vector  at  the  initial  posi- 
tion (i.  e. , the  required  velocity),  as  well  as  the  velocity  vector  at  the  terminal 
position,  is  calculated  from  the  last  adjusted  value  of  the  independent  variable. 

In  the  less-than-one-complete  revolution  case  in  both  routines,  the  upper  and 
lower  bounds  on  the  independent  variable  are  explicitly  computed  since  the  depen- 
dent and  independent  variables  are  monotonically  related.  However,  in  the  multi- 
revolution case  in  the  Lambert  routine,  there  are  two  distinct  physically-meaning- 
ful  transfers  which  solve  the  problem  , and  an  iterative  procedure  (entirely  separate 
from,  and  not  containing  nor  contained  in  the  previously  described  iteration  scheme) 
must  be  used  to  solve  for  the  value  of  the  independent  variable  which  separates  the 
two  regions  in  each  of  which  exactly  one  solution  lies  so  that  upper  and  lower  bounds 
may  be  established  corresponding  to  the  unique  solution  desired.  The  multi-revo- 
lution case  for  the  de-orbit  problem  is  not  considered  in  this  document. 
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ENTER 


EXIT 


Figure  1.  Conic  Lambert  and  De-orbit  Required  Velocity 

Determination  Routines  Functional  Flow  Diagram 


/- 
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9. 7. 1.1  Conic  (continued 


3.  INPUT  AND  OUTPUT  VARIABLES 

The  Conic  Required  Velocity  Determination  Routines  have  only  one  uni- 
versal constant:  the  gravitational  parameter  of  the  earth.  However,  associated 
with  each  of  the  routines  are  a number  of  more  or  less  fixed  constants  which  are 
primarily  convergence  tolerance  criteria.  Since  their  values  will  be  firmly 
established  when  the  routines  are  coded  into  the  Orbiter  computer,  they  are 
not  shown  as  input  parameters  below.  The  principal  real-time  input  variables 
are  the  initial  inertial  position  vector,  the  desired  transfer  time  interval,  and 
either  the  desired  terminal  position  vector  for  the  Lambert  problem  or  the  desired 
terminal  radius  and  flight-path  angle  for  the  de-orbit  problem.  The  principal 
real-time  output  of  both  routines  is  the  inertial  required  velocity  vector. . 

3.1  Lambert  Required  Velocity  Determination 

Input  Variables 

j~q  Initial  or  current  inertial  position  vector  (corre- 

sponds to  time  tQ  ). 

r j Terminal  or  target  inertial  position  vector  (corre- 

sponds to  time  1 1 ) . 

At  Transfer  time  interval  (t  ^ - tp)  between  £q 

and  r ^ . 

n^  Integer  number  of  complete  360°  revolutions  to 

be  made  in  the  desired  transfer.  [ Hence  the 

transfer  will  be  between  n~  and  n_  + 1 revolu- 

n n 

tions  ] . 

Ssoln  Switch  indicating  which  of  the  two  physically  pos- 

sible solutions  is  desired  in  the  multi-revolution 
case.  [ Not  used  in  the  less-than- 360°  transfer 
case]  . In  particular,  = -1  indicates  the  solution 

with  the  smaller  initial  flight  path  angle  y q 

measured  from  vertical,  and  s , = +1  indicates  the 

soln 

one  with  the  larger  y ^ . 
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sguess 


Switch  indicating  whether  the  routine  is  to  compute 

its  own  guess  of  the  independent  variable  to 

start  the  iterative  procedure  (s  =0),  or  is 

gUGS  S 

to  use  a guess  I^uess  supplied  by  the  user 

(s  =1). 

guess 


Sguess  Guess  of  independent  variable  1^  corresponding 

to  solution  (disregarded  when  Sguess  = 0). 

e Tolerance  criterion  establishing  small  cones  around  ' 

cone 

the  positive  and  negative  target  position  directions 

inside  of  which  the  routine  will  define  tne  plane  of  the 

transfer  by  the  unit  normal  vector  i ■ , rather  than 

the  cross  product  of  rrt  and  r , . The  tolerance  e 

^ -0  —1  cone 

is  the  sine  of  the  half-cone  angle. 


s Switch  indicating  whether  the  initial  and  target  posi- 

proj 

tion  vectors,  r Q and  r 1 , are  to  be  projected  into 

the  plane  defined  by  the  unit  normal  _iN  before  the 

main  Lambert  computations  are  performed.  If 

s . = 0,  no  projection  will  be  made  unless  the  initial 
proj 

position  vector  r ^ is  found  to  lie  within  one  of  the  cones 

defined  by  e . If  s =1,  the  projections  are 

J cone  proj  J 

always  made. 


— N 


Unit  vector  normal  to  transfer  plane  and  in  direction 

of  angular  momentum  vector  of  transfer.  The  vector 

_i^  always  determines  the  direction  of  the  transfer, 

and  will  also  determine  the  plane  of  the  transfer  when 

either  the  switch  s = 1,  or  the  switch  s =0 
proj  proj 

but  the  initial  position  vector  is  inside  one  of  the 
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9. 7. 1.1  Conic  (continued) 


Output  Variables 


!0 


Inertial  velocity  required  at  the  initial  position 
Tq  to  transfer  to  the  terminal  position  r ^ in 
exactly  the  specified  time  interval  At. 


h 


Inertial  velocity  at  the  terminal  position  _r  ^ 


cone 


Value  of  independent  variable  to  which  the  last 
iteration  converged. 

Switch  indicating  the  outcome  of  the  cone  test.  If 

s =0.  the  initial  position  r . lies  outside  both 
cone  —0 

of  the  cones  around  the  positive  and  negative  target 

position  vectors.  If  s =1,  it  lies  inside  one  of 

cone 

these  cones. 


Terminal  or  target  position  vector  actually  used  in 

computations.  It  is  different  from  input  r only 

if  projection  was  performed.  (See  s and  s 

proj  cone 

switches.  ) 


sin  e 
cos  6 


Sine  and  cosine  of  the  transfer  angle. 


'N 


Reciprocal  of  normalized  semi-major  axis  of 
conic  transfer  orbit  ( a ^ = r q / a ). 


N 


Normalized  semi-latus  rectum  of  conic  transfer 
orbit  ( pN  = p/  rQ  ). 


Universal  eccentric  anomaly  difference  corre- 
sponding to  the  transfer  from  r^  to  _r^. 
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2 2 

| The  variable  ax  ^ = x /a  = ^ jsj  x /r0' 

S(4),  C(4)  Values  of  the  S and  C functions  corresponding  to 
' the  transfer  from  rQ  to  r l . (Used  by  the  Auto- 
matic Initialization  Routine  of  the  Relative  State 
Updating  Function  to  compute  sensitivity  matrices). 

De-orbit  Required  Velocity  Determination  , 

Input  Variables  . ,r  • . 

rQ  Initial  or  current  inertial  position  vector  (cor- 

responds to  time  tg). 

y Flight-path  angle  at  terminal  or  target  position 

measured  from  local  vertical  (corresponds  to 
time  t^). 

r ^ Radius  at  terminal  or  target  position  (corre- 

sponds to  time  t j ). 

[NOTE:  rx  must  be  less,  than  |r0|.] 

At  Transfer  time  interval  (tj^  - tQ)  between 

initial  and  terminal  positions. 


guess 


Flag  indicating  whether  the  routine  is  to  compute 

its  own  guess  of  the  independent  variable  Tg  to 

start  the  iterative  procedure  (sguess  = °)<  or  is  to 

use  a guess  r„uess  supplied  by  the  user 

(s  = 1). 

' guess 


L guess 


Guess  of  independent  variable  JTg  correspond- 
ing to  solution  (disregarded  when  sguesg  = 0). 
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9. 7. 1.1  Conic  (continued) 


— N 


Unit  vector  which  defines  the  plane  and  the  direc- 
tion of  the  transfer;  it  is  normal  to  the  transfer 
plane  and  in  the  direction  of  the  angular  momentum 
vector  of  the  transfer. 

Output  Variables 


vQ  Inertial  velocity  required  at  the  initial  position 

Tq  to  transfer  to  the  terminal  flight-path  angle 
and  radius  in  exactly  the  specified  transfer 
time. 


Il 


Inertial  velocity  at  the  terminal  position. 


ro 


Value  of  the  independent  variable  to  which  last 
iteration  converged. 


Inertial  position  vector  at  the  terminal  position. 


sin  6 
cos  6 


Sine  and  cosine  of  transfer  angle. 


a 


N 


Reciprocal  of  normalized  semi-major  axis  of 
conic  transfer  orbit.  { a;  = r^  / a ) 


P 


N 


Normalized  semi-latus  rectum  of  conic  transfer 
orbit  ( pN  = p / r 0 ) 


x 


Universal  eccentric  anomaly  difference  cor- 
responding to  transfer  from  £q  to  r ^ ■ 
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9. 7. 1.1  Conltr  ‘(continued) 


2 2 2 

I The  variable  ax  - x /a  = aNx  / rQ 

S(|),  C (|)  Values  of  the  S and  C functions  corresponding 

to  the  transfer  from  to  £ . (May  be  used 
by  other  routines  to  evaluate  sensitivity  matrices. ) 
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9. 7. 1.1  Conic  (continued) 


4.  DESCRIPTION  OF  EQUATIONS 

The  following  description  applies  to  both  the  Lambert  and  De-orbit  problems 
unless  otherwise  noted. 

4.  1 Preliminary  Comments 

A combination  of  the  Marscher  Equation  Inversion  and  the  Stumpff-Herrick- 
Battin  Universal  Kepler  Equation  is  used  in  this  formulation  of  the  solutions  to  the 
Lambert  and  De-orbit  problems.  This  is  the  particularly  convenient  when  used  in 
conjunction  with  the  Kepler  and  Theta  problem  solutions  described  previously 
(Ref.  7 ) as  those  problems  utilize  the  same  two  equations,  which  may  hence  be 
coded  for  a computer  as  common  subroutines. 


The  independent  variable  in  the  iterative  solution  in  both  the  Lambert  and 
De-orbit  routines  is  the  cotangent  of  the  flight-path  angle  at  the  initial  position 
measured  from  local  vertical,  and  this  variable  is  denoted  by  Tq  . Thus  = 

cot  yQ  with  yQ  being  the  angle  from  the  initial  position  vector  r Q (extended)  to 
the  as  yet  unknown  required  velocity  vQ  . A guess  of  the  independent  variable 
is  transformed  by  the  Marscher  Equation  Inversion  into  a corresponding  value  of 
the  universal  eccentric  anomaly  difference  x,  from  which  the  corresponding  trans- 
fer time  interval  Atc  between  the  initial  and  terminal  positions  is  evaluated  by  the 
Universal  Kepler  Equation.  The  subscript  "c"  on  the  dependent  variable  At£  in- 
dicates the  calculated  transfer  time  interval  determined  from  some  value  of  I"g  , 
as  opposed  to  the  desired  transfer  time  interval  At  specified  in  the  input.  The 
universal  eccentric  anomaly  difference  x may  be  defined  by  the  relations: 


x 


(E  - Eg)  for  ellipse 

=<  y'p"  (tan  f / 2 - tan  f q/2)  for  parabola 
J~-a  (H  - Hg)  for  hyperbola 


where  a is  the  semi-major  axis,  E and  H are  the  eccentric  anomaly  and  its  hyper- 
bolic analog,  p the  semi-latus  rectum  and  f the  true  anomaly. 


4.  2 Computation  of  the  Conic  Parameters 

In  order  to  evaluate  the  transfer  time  interval  At  for  a given  value  of  the 
independent  variable  Tg  , it  is  first  necessary  to  obtain  the  intermediate  para- 
meters a N and  p N . 
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In  the  Lambert  problem  case,  the  normalized  semi-latus  rectum  = 
p/rQ  and  the  normalized  semi-major  axis  reciprocal  = r^  a = r^  / a are 
determined  from  the  central  transfer  angle  9,  the  initial  and  terminal  radii  rQ 
and  r ^ (these  three  parameters  being  constant  throughout  any  one  problem),  and 
from  the  value  Iq  of  the  independent  variable  by  the  equations: 

1 - cos  0 

PN  ” r0  sin  9-  (cos  9-  rQ/  r^) 

° N * 2-Pn<’  +r02) 

In  the  De-orbit  problem  case,  the  central  transfer  angle  is  not  known  di- 
rectly from  the  input  (it  depends  on  the  current  value  of  Tq)  • The  parameters 
Pj^j  and  a ^ are  instead  computed  from  the  desired  terminal  flight  path  angle  Y^, 
and  the  initial  and  terminal  radii  Tq  and  r^  (these  three  parameters  being 
constant  throughout  any  one  problem)  and  from  the  value  Tq  of  the  independent 
variable  by  the  equations: 

2 (X-  1 ) 

PN  = qX  - (1  + T02) 

“ N = 2 ~ PN  ( 1 + ^0  * 

where 

2 

X = r o / r i and  q = X / sin  T ^ . - 


4.  3 Computation  of  the  Transfer  Time  Interval  and  Required 
Velocity  Vector 

When  the  conic  parameters  p^  and  are  known  for  a particular  value 

Tp  of  the  independent  variable  in  either  the  Lambert  or  De-orbit  problem,  the 
universal  eccentric  anomaly  difference  x is  obtained  from  the  Marscher  Equation 


-r„ 


Inversion: 

Let 

W i = 

1 [ sin  9 

\J  p N \ l - cose 

If 

KIm, 

let  V 1 = 1. 

Let 

W n + ! = 

+ /w„2  + “n'+ 

or 

( |Wj  |<  1) 
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or 


V„+1  ' + + “N(l1/Wll  >a'+  Vn  'Kl>i: 


Let 


co  = W 
n n 


( |wj<l) 


or 


! / « n = ( IVWlh/  V n 


( Wj  >1) 


Let 


co  . 2j  + 1 \co  / 

n ] = 0 J n 


where  n is  an  integer  >4.  Then 


/^fT0 


¥ 


2 


(wx  > 0) 


( W x < 0) 


The  above  equations  have  been  specifically  formulated  to  avoid  certain  numerical 
difficulties. 

Finally,  the  transfer  time  interval  At  is  evaluated  by  the  Universal 
Kepler  Equation: 


(t  1 - t q)  = Atc=  [ C1  x2C(l)+x(c2x2S(4)  + r0)]/  Vp  E 
c 

where 


C1  c 

V r o pn 

ro 

C 2 

1 - a 

N 

4 = 

aNx2/ 

r0 

C(  4 ) 

1 

2 ! 

4 

4! 

+ il  - 
6! 

S (4) 

1 

3 ! 

4 

5 ! 

4 2 

+ TT  ' 
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Since  the  transfer  time  interval  At  is  specified,  it  is  desired  to  find  the' 
Tq  corresponding  to  it  through  the  above  equations,  and  then  to  evaluate  the 
required  velocity  vector  using  the  expression 


where  i_r  and  i_^  are  unit  vectors  in  the  directions  of  £q  and  the  angular 
momenturrPvector  respectively. 


4.  4 Iteration  Method  and  Independent  Variable  Bounds 


Unfortunately,  the  combination  of  the  Marscher  Equation  Inverstion  and 
the  Universal  Kepler  Equation  expresses  the  transfer  time  interval  At  as  a 
transcendental  function  of  rather  than  conversely,  and  no  power  series  in- 
version of  the  relationship  is  known  which  has  good  convergence  properties  for 
all  orbits,  so  it  is  necessary  to  solve  the  relationship  iteratively  for  the  inde- 
pendent variable  Fq. 


For  this  purpose,  the  secant  method  (linear  inverse  interpolation  / extra- 
polation) is  used.  It  merely  finds  the  increment  AFq  in  the  independent  variable  1^ 
which  is  required  in  order  to  adjust  the  dependent  variable  Atc  to  the  desired 
value  At  based  on  a linear  interpolation  / extrapolation  of  the  last  two  points  cal- 

The  method  uses  the  formula 


culated  on  the  At  vs 
c 


• ( 


Tq  curve, 
(n  + 1) 


0 


n- 


At 


At ; 


(n) 

TnT 


- At 


- At 


(n  - 1) 


ro 


(n) 


-ro 


(n  - 1) 


) 


/ \ 

where  At  denotes  the  evaluation  of  the  Marscher  Equation  Inversion  followed 

by  the  Universal  Kepler  Equation  using  the  nth  value  1^  ^ of  the  independent 
variable. 

In  order  to  prevent  the  scheme  from  starting  in  or  iterating  into  regions  in 
which  it  is  known  on  theoretical  grounds  that  no  physically  valid  solution  can  occur, 
it  is  necessary  to  establish  a priori  upper  and  lower  bounds  on  the  independent 
variable  1^.  The  bounds  are  also  useful  in  preventing  the  taking  of  an  increment 
back  into  regions  in  which  past  iterations  have  shown  that  the  solution  does  not 
lie;  this  is  accomplished  by  continually  resetting  the  bounds  during  the  course  of 
the  iteration  as  more  and  more  values  of  are  found  to  be  too  large  or  too 
small.  In  addition,  it  has  also  been  found  expedient  to  damp  by  10%  away  from  the 
current  bound  any  increment  in  the  independent  variable  which  would  (if  applied) 
take  the  value  of  the  independent  variable  past  this  bound.  Furthermore,  in  the 
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multiple-revolution  Lambert  case,  the  bounds  are  indispensable  in  constraining 
the  problem  to  the  desired  one  of  the  two  physically  possible  solutions. 


To  start  the  iteration  scheme,  two  successive  initial  guesses, 


(0) 


0 


and 


/ 1 \ ^ 

IT  ' \ of  the  independent  variable  are  required.  In  the  lack  of  other  information 


(0) 


may  be  taken  as  the  midpoint  of  the  interval  between  the  bounds  over  which 


I^j  may  vary,  and  1^  ^ as  a point  biased  away  from  1^  'u/  by  the  relatively 
large  fraction  k^g  (perhaps  1/4)  of  that  interval.  This  procedure  will  automati- 
cally be  performed  by  the  routines  described  in  the  detailed  flow  diagram  section 
when  the  switch  Sguegg  = 0.  However,  if  some  relatively  good  guess  of  the  inde- 
pendent variable  is  available,  such  as  a linear  extrapolation  of  the  values  of  the 
independent  variable  to  which  the  last  two  calls  of  the  Lambert  or  De -orbit  routine 
had  converged  during  powered  flight  guidance,  then  this  guess  should  obviously  be 
used  as  ^ , and  ]Tn  ^ should  be  a point  biased  away  from  1^  ^ by  only  a 


(0) 


•o 


Lo 


relatively  small  fraction  k (perhaps  1/10000)  of  the  interval  between  the 

bounds.  This  procedure  will  automatically  be  carried  out  by  the  diagrammed 

routines  when  the  switch  s_  „„„  = 1. 

guess 

The  iteration  continues  until  the  calculated  transfer  time  interval  has  been 
driven  to  within  the  relative  error  e of  the  desired  transfer  time  interval, or  until 


two  successive  calculated  transfer  time  intervals  differ  by  less  than  e ' , or  until 

the  maximum  number  i of  iterations  has  been  reached,  or  until  the  increment 

max 

aT0  in  the  independent  variable  is  less  than  a certain  minimum  value 


4.  5 Computation  of  the  Bounds  in  the  Lambert  Problem 

In  the  less-than-one-complete-revolution  case  in  the  Lambert  problem,  the 
lower  and  upper  bounds  on  the  independent  variable  are  computed  from: 


( ( cos 

( - co 


r o / r i ) / sin  6 


(O<0  < 1 80u  ) 
(18O°<0<36O°) 


sin  0 


1 - cos  0 


/ 2 (r  0 / r 1 
V 1 - cos  0 


(O<0<36O° ) 


These  equations  result  from  the  constraints  of  having  finite  semi-latus  rectums 
(I^nin)  and  not  transferring  "through  infinity"  the  transfer  time  in- 

terval _it  is  zero  at  r • and  infinite  at  T" 

c min  •‘■max 
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In  the  multiple-revolution  Lambert  case,  the  bounds  must  be  adjusted  to 
reflect  the  fact  that  such  transfers  can  only  occur  on  elliptic  orbits.  The  upper 
bound  1^^  already  corresponds  to  the  "longer"  of  the  two  possible  parabolic 
transfers,  while  the  value  of  the  independent  variable  corresponding  to  the 
"shorter"  (and  physically  realizable)  one  is: 


sin  e 


Lparab 


cos  6 


/2(ro/ri> 

VI-  cos  0 


Hence  the  independent  variable  may  not  vary  outside  the  interval  (max  ( T 

min  ’ 

lparab  ’ ^max'  for  the  multiPle  revolution  case.  Moreover,  in  this  case, 
there  are  two  physically  possible  transfers  having  the  same  transfer  time  interval 
but  different  values  of  the  independent  variable.  A graph  of  the  typical  functional 
relationship  is  shown  in  Figure  2. 


Atc 


Figure  2.  Typical  Relationship  Between  Dependent  and  Independent 
Variables  in  Multiple  Revolution  Lambert  Problem 
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To  distinguish  between  the  two  possible  solutions,  it  is  necessary  to  find  the  value 
of  r0  corresponding  to  the  minimum  of  Atc-  This  is  accomplished  by  a secant 
iteration  on  the  secant,  i.  e.  , by  a secant  iteration  on  the  numerical  approximation 
to  the  first  derivative  of  the  curve.  Obviously,  it  is  now  desired  to  drive  the  value 
of  the  first  derivative  to  zero.  A good  starting  point  for  the  iteration  is  furnished 
by  the  value  of  the  independent  variable  corresponding  to  the  minimum  energy 
transfer: 


where 


lME 


180  -r, 


* ic-l  / 11  + i, 


1 

-c“ 


irQ  is  the  unit  initial  position  vector, 

i _ is  the  negative  unit  chord  vector  connecting  the 
initial  and  terminal  points  (the  chord  vector 
goes  from  the  initial  to  the  terminal  point)  , 


and 


s is  the  sign  of  the  sine  of  the  transfer  angle. 


Once  the  value  of  Pq  corresponding  to  a minimum  of  At  c has  been  found,  it 
serves  to  separate  the  interval  into  two  subintervals  in  each  of  which  exactly  one 
solution  lies,  and  hence  the  minimum  point  is  taken  as  a further  upper  or  lower 
bound  depending  on  which  solution  is  desired  in  order  to  constrain  the  variation 
of  the  independent  variable  to  one  of  the  two  subintervals.  In  one  of  the  subinter- 
vals the  biasing  constant  k must  be  reversed  in  sign  since  the  dependent  variable 
there  is  a monotonically  decreasing  function  of  the  independent  variable,  rather 
than  a monotonically  increasing  one. 


4.  6 Computation  of  the  Bounds  in  the  De-orbit  Problem 

Only  the  less-than-one-complete-revolution  case  has  been  considered  for 
the  De-orbit  problem  in  this  document.  The  lower  and  upper  bounds  on  the  inde- 
pendent variable  for  this  case  are  computed  from: 

rmin  ■ - V<1+C°,2’'l  1 (tVrl)2  • 1 

rma  * * V(1  "'o''.1 
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The  transfer  time  interval  At  is  zero  at  T ■ and  infinite  at  F 

..  . L min  max 

equations  are  equivalent  to 

rmin  = ' V9  X - 1 


max 


= + V q - 1 


where 

X r o / r i anc^  q = X / sin  ^ Y ^ as  before. 

It  is  to  be  noted  that  these  bounds  are  based  on  the  assumption  that  the 
terminal  radius  is  less  than  the  initial  radius  ( A = r Q / r x > 1 ) . When  the 

converse  is  true,  a different  and  rather  more  complex  set  of  bounds  is  valid  in- 
stead. 


4-  7 Treatment  of  the  180°  Transfer  Singularity  in  the 

Lambert  Problem  ~ " — 

For  transfers  of  exactly  180°  (or  540° , 900°  , etc. ),  Lambert1  s problem 
has  a partial  physical  singularity  in  that  the  plane  of  the  transfer  becomes  inde- 
terminate although  the  other  orbit  parameters, such  as  flight  path  angle  and  re- 
quired velocity  magnitude, are  well-determined  by  the  specification  of  the  desired 
transfer  time  interval.  A transfer  in  any  plane  with  the  correct  other  parameters 
will  solve  the  problem  mathematically  and  physically.  In  actual  computer  solu- 
tions to  Lambert' s problem,  however,  the  singularity  will  arise  not  only  at  ex- 
actly the  180  transfer  but  also  everywhere  within  a small  neighborhood  of  the 
180  direction,  due  to  the  fact  that  the  computer,  whether  fixed  or  floating  point, 
has  a finite  word  length  and  cannot  carry  out  the  cross-product  of  the  initial  and 
target  vectors  with  infinite  precision.  The  small  neighborhood,  inside  of  which 
the  transfer  plane  must  be  defined  by  other  means,  may  be  conceived  of  as  a cone 
with  apex  at  the  origin  and  with  axis  along  the  negative  target  position  direction. 

In  fact,  since  the  singularity  also  occurs  in  the  vicinity  of  0°  (360°,  720°,  etc.  ) 
transfers,  two  cones  may  be  established  point  to  point  along  both  the  negative  and 
positive  directions.  The  sine  of  the  half-cone  angle  of  these  cones  has  been  de- 
noted by  fcone  in  this  document. 
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For  transfers  in  the  vicinity  of  integral  multiples  of  180°  but  for  which  the 
initial  position  vector  r is  outside  the  singularity  cones  described  above,  the 
plane  in  which  the  solution  of  Lambert' s problem  lies  is  highly  sensitive  both 
mathematically  and  physically  to  the  input  initial  and  target  position  directions, 
due  to  the  near-colinearity  of  these  vectors.  The  computer  will  be  able  to  calcu- 
late the  plane  of  the  solution  in  these  high  sensitivity  regions  since  £^  is  not  in-' 
side  the  singularity  cones.  However,  in  these  regions  slight  movements  of  either 
of  the  input  position  vectors  can  cause  the  plane  spanned  by  them,  and  hence  the 
required  velocity  plane,  to  drastically  change  its  orientation  — for  example,  from 
an  around-the -equator  to  an  over-the-pole  direction.  This  could  have  great  con- 
sequences during  the  operation  of  various  functions  such  as  powered-flight  guid- 
ance. Thus,  in  order  to  avoid  system  operational  difficulties,  it  is  important  to 
take  into  account  the  high  sensitivity  regions,  inside  of  which  the  transfer  plane 
should  be  defined  by  other  means  such  as  an  input  unit  normal,  even  though  the 
Lambert  problem  solution  is  non-singular  there. 

The  Lambert  Routine  diagrammed  in  the  next  section  has  been  designed 

with  provision  for  both  the  singularity  cones  and  the  sensitivity  regions.  As  the 

angular  shape  of  the  cones  is  well  determined,  the  routine  will  (1)  test  to  decide 

whether  the  initial  position  vector  r ^ is  outside  or  inside  the  cones  based  on  the 

angular  size  given  by  fcone-  (2)  set  the  cone  switch  scone  to  0 or  1 respectively 

to  indicate  the  result  to  the  user,  and  (3)  utilize  an  input  unit  normal  vector  i , 

-N 

to  define  the  transfer  plane  in  the  inside-the-cone  case.  On  the  other  hand,  as 
the  angular  shape  and  size  of  the  sensitivity  regions  may  vary  according  to  each 
system  function  which  utilizes  a Lambert  problem  solution,  the  Lambert  routine 
requires  the  setting  of  an  input  switch  Sproj  t°  indicate  whether  the  initial  posi- 
tion vector  £q  is  to  be  considered  as  outside  or  inside  a sensitivity  region.  * In 
the  inside-the-region  case,  the  routine  will  project  the  input  initial  and  target 

The  rationale  for  the  choice  and  the  detailed  flow  diagrams  precisely 
defining  it  are  given  in  the  document  describing  the  particular  func- 
tion. For  the  targeting  and  powered-flight  guidance  functions,  they 
are  given  in  the  Precision  Required  Velocity  Determination  document 
(Ref.  2). 
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position  vectors  £^  and  £^  into  the  plane  defined  by  the  input  unit  normal  vec- 
tor _i^  before  any  main  computations  are  performed,  and  will  utilize  the  normal 
to  determine  the  transfer  plane.  In  the  outside-the-sensitivity-region  case,  the 
routine  will  perform  the  singularity  cone  test  previously  described  as  a double- 
check on  the  setting  of  the  projection  switch  s q.  • and  if  the  initial  position  £^ 
is  not  inside  the  cone  the  unit  normal  to  the  transfer  plane  will  be  calculated  in- 
ternally from  the  cross  product  of  the  initial  and  target  vectors.  Should  the  cone 

test  find  the  initial  position  inside  the  cone,  the  cone  switch  s will  be  set  to 

cone 

1 as  a warning,  and  the  routine  will  override  the  zero  setting  of  the  projection 
switch  and  project  the  initial  and  target  vectors  into  the  plane  defined  by  the  input 
unit  normal  _i^  as  in  the  inside-the-sensitivity- region  case  above. 

It  should  be  pointed  out  that  the  unit  normal  _i^  must  always  be  input  and 
must  always  be  in  the  direction  of  the  desired  angular  momentum  vector  of  the 
transfer.  In  the  outside-the-sensitivity-region  case  exactly  one  bit  of  information 
is  extracted  from  _i  ■,  namely  the  polarity  of  the  desired  angular  momentum,  or 
whether  the  transfer  is  clockwise  or  counterclockwise  when  viewed  from  the  tip 
of  the  cross-product  vector  of  the  initial  and  target  positions.  * In  the  inside-the- 
sensitivity-region  or  inside-the-cone-cases,  the  input  unit  normal  provides 
orientation  as  well  as  polarity. 

It  should  also  be  noted  that  a first  approximation  to  a sensitivity  region  is 
a cone  of  larger  central  angle  centered  around  the  singularity  cone.  As  the  para- 
meter e is  an  input  variable,  the  Lambert  routine  diagrammed  in  the  next  sec- 
tion  may  be  used  to  determine  whether  the  initial  position  vector  rQ  lies  inside 
this  larger  cone-shaped  approximation  to  a sensitivity  region  by  suitably  adjusting 
£cone'TMS  technique  is  utilized  by  the  Precision  Required  Velocity  Determination 
Routine. 


The  reader  is  reminded  that  the  cross  product  operation  always 
orients  its  result  as  if  a right  hand  rotation  were  made  through 
the  smaller  of  the  two  angles  from  the  initial  to  the  target  vector 
which  lie  in  the  plane  of  these  vectors. 
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5.  DETAILED  flow  diagrams 

5.  1 Multiple-Revolution  Lambert  Required  Velocity 
Determination  Routine 


This  routine  utilizes  the  following  subroutines  or  coding  sequences,  which 
are  diagrammed  in  Section  5.  3: 


• Lambert  Transfer  Time  Interval  Subroutine 

•Marscher  Equation  Inversion  Subroutine 

• Universal  Kepler  Equation  Subroutine 

• Secant  Iterator 

• Multi-revolution  Bounds  Adjustment  Coding 

Sequence 

• Secant  Minimum  Iterator 
UNIVERSAL  PROGRAM 

CONSTANTS  CONSTANTS  INPUT  VARIABLES 


Figure  3a.  Multi-Revolution  Lambert  Routine 
Detailed  Flow  Diagram 
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Figure  3b.  Multi-Revolution  Lambert  Routine 
Detailed  Flow  Diagram 
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Figure  3c.  Multi-Revolution  Lambert  Routine 
Detailed  Flo*v  Diagram 
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Figure  3d.  Multi-Revolution  Lambert  Routine 
Detailed  Flo»v  Diagram 
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5.  2 De-orbit  Required  Velocity  Determination  Routine 

This  routine  utilizes  the  following  subroutines  which  are  diagrammed  in 
Section  5.  3: 

• De-orbit  Transfer  Time  Interval  Subroutine 

• Marscher  Equation  Inversion  Subroutine 
•Universal  Kepler  Equation  Subroutine 

• Secant  Iterator 

UNIVERSAL  PROGRAM 

CONSTANTS  CONSTANTS  INPUT  VARIABLES 


Figure  4a.  De-orbit  Routine 

Detailed  Flow  Diagram 
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Figure  4b.  De-orbit  Routine 

Detailed  Flow  Diagram 
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Figure  4c.  De-orbit  Routine 

Detailed  Flow  Diagram 
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Subroutines  or  Coding  Sequences  used  by  the  Conic 
Required  Velocity  Determination  Routines 


5.  3.  1 Lambert  Transfer  Time  Interval  Subroutine 
UNIVERSAL 

CONSTANTS  INPUT  VARIABLES 


Figure  5.  Lambert  Transfer  Time  Interval  Subroutine 
Detailed  Flow  Diagram 
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5.  3.  2 De-orbit  Transfer  Time  Interval  Subroutine 


INPUT 

VARIABLES 


Figure  6.  De-orbit  Transfer  Time  Interval  Subroutine 
Detailed  Flow  Diagram 
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5.  3.  3 Universal  Kepler  Eauation  Subroutine 


This  subroutine  is  identical  to  the  one  used  in  the  Kepler  and  Theta  problems. 


UNIVERSAL  INPUT 
CONSTANTS  VARIABLES 


Figure  7.  Universal  Kepler  Equation  Subroutine 
Detailed  Flow  Diagram 
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re  8a.  Marscher  Equation  Inversion  Subroutine 
Detailed  Flow  Diagram 
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Figure  8b.  Marscher  Equation  Inversion  Subroutine 
Detailed  Flow  Diagram 
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5.  3.  5 Secant  Iterator 

This  subroutine  is  identical  (when  k = 1/4)  to  the  one  used  in  the  Theta 
problem. 


INPUT  VARIABLES 


Figure  9.  Secant  Iterator 

Detailed  Flow  Diagram 
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Figure  10b.  Multi-Revolution  Bounds  Adjustment  Coding  Sequence 
Detailed  Flow  Diagram 
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At  < Atc; 


r 

A 

max 

^min 

max 

Iparab) 

kbg 

'kbg 

k - 

-k 

sm 

sm 

(to  Lambert  Rou- 
tine, Figure:  3b) 


ERROR  EXIT 

(No  solution  possible  to 
this  Lambert  problem: 
too  many  revolutions 
for  too  short  a speci- 
fied transfer  time  in- 
terval) 


Figure  10c,  Multi- Revolution  Bounds  Adjustment  Coding  Sequence 
Detailed  Flow  Diagram 
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5.  3.  7 Secant  Minimum  Iterator 

This  subroutine  is  very  similar,  though  not  identical,  to  the  Secant 
Iterator.  They  can  easily  be  combined  into  one  routine,  although  they  have 
been  diagrammed  separately  here  for  purposes  of  clarity. 


INPUT  VARIABLES 


Figure  11.  Secant  Minimum  Iterator 
Detailed  Flow  Diagram 
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6.  SUPPLEMENTARY  INFORMATION 

The  formulation  of  the  solutions  of  the  Lambert  and  De-orbit  problems  in 
terms  of  an  iteration  on  the  cotangent  of  the  initial  flight  path  angle  was  con- 
ceived by  Marscher  (1965),  who  developed  all  the  fundamental  relationships  in- 
cluding the  bounds  and  the  remarkable  Marscher  Equation: 

6 r 0 AE 

cot  j = yp'T  cot  y + cot  7 Q (elliptic) 


cot  g = 


/-pa 


coth. 


AH 

~2~ 


+ cot  y 


(hyperbolic) 


or  in  universal  form: 


, e r0 

cot  ■?  = -==r 

2 VF 


[1  -ax^  S (a  x ^ ) ] 
x C (ax2) 


+ cot  y 


o 


Marscher's  original  solutions  of  the  Lambert  and  De-orbit  problems,  however, 
involved  a double  loop  iterative  procedure  in  which  the  universal  Marscher  Equa- 
tion was.  solved  iteratively  for  x in  an  inner  loop  during  each  pass  through  the 
outer  loop  iteration  on  cot  7^  and  the  transfer, time  interval.  Marscher's 
solutions  were  simplified  to  a single  loop  iteration  through  the  inversion  of 
Marscher's  Equation  which  was  derived  by  Robertson  (1967).  The  expressions 
for  the  Universal  Kepler  Equation  and  the  terminal  velocity  vector  are  well 
known  and  are  given  in  Bat-tin  (1964). 

Krause  organized  the  details  of  the  computation  in  both  routines.  He  also 
developed  the  two  secant  iterators  (Krause,  1967). 

The  formulation  of  the  Lambert  and  De-orbit  problems  given  in  the  pre- 
ceeding  sections  is  essentially  that  used  in  the  Apollo  program,  and  hence  has_ 
been  thoroughly  exercised.  Among  the  major  advantages  of  this  formulation  are; 
(1)  the  use  of  an  independent  variable  which  is  simply  related  to  a single  physical 
quantity  of  practical  interest  (the  flight-path  angle),  and  (2)  the  sharing  of  large 
portions  of  the  calculation  between  the  Lambert,  De-orbit,  Kepler,  and  Theta 
Routines  in  the  form  of  common  subroutines,  permitting  a considerable  reduction 
in  the  amount  of  computer  memory  required  for  the  storage  of  the  instructions. 

A limitation  of  the  formulation  is  that  it  cannot  handle  rectilinear  transfers  since 
the  independent  variable  TQ  is  infinite  for  all  such  cases. 

The  value  of  TQ  corresponding  to  the  minimum  energy  transfer  may  be 
derived  from  a consideration  of  problem  3.4  of  Battin  (1964). 
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GN&C  SOFTWARE  EQUATION  SUBMITTAL 

Software  Equation  Section  Required  velocity  determination  (precision) 

Submittal  No.  27A 

Function:  To  provide  initialization  of  powered  flight  guidance  equations  for 

short  finite-length  burns. 


Module  No.  OG-3  Function  No.  1.2.3  (MSC  03690) 

OG-5  1,2 

Submitted  byi  T.  Brand Co.  MIT  No.  13  (Rev.  1) 
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NASA  Contract:  C.  Lively Organization  EG-2 

Approved  by  Panel  III  Date_  '*/«*  hi 

Summary  Description:  This  routine  provides  targeting  for  powered  flight 

guidance  during  short  burns  in  a non-Keplerian  gravity  field.  The  effects 
of  finite  burn  times  and  of  perturbations  from  a conic  gravity  field  are 

accommodated  by  an  offset  target  such  that  during  the  manuever.  simple __ 

conic  computations  may  be  .employed  with  great  accuracy.  The  revision  in- 
cludes logic  (1)  to  preclude  difficulties  for  transfer  angles  near  180° 

and  (2)  to  permit  disabling  gravity-perturbation  computations. 

Shuttle  Configuration:  The  software  iB  essentially  independent  of  configura- 


Comments : 

(Design  Status)  

(Verification  Status) 


Panel  Comments: 


Revision:  A.  Prior  submittal  Aug.  1971 
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9. 7. 1.2  Precision  (continued) 


1.  INTRODUCTION 


Calculation  of  the  precision  required  velocity  which  satisfies  terminal 
position  and  time-of-flight  constraints  in  a non-Keplerian  gravity  field  is  a com- 
putation time  consuming  process,  especially  in  an  on-board  computer.  There- 
fore, targeting  calculations  prior  to  a maneuver  are  customarily  used  to  predict 
and  compensate  for  the  effects  of  the  perturbations  from  a conic  gravity  field, 
so  that  during  the  maneuver  only  the  much  simpler  conic  related  computations 
will  have  to  be  performed. 

For  Lambert  aim  point  maneuvers  (described  in  Reference  2)  an 
adjustment  to  the  terminal  (target)  position  vector  will  suffice  to  provide  this 
compensation.  This  adjusted  terminal  position,  referred  to  as  an  offset  tar- 
get, must  compensate  for  gravity  perturbations  throughout  both  the  maneuver 
and  subsequent  coasting  flight.  Then  the  required  velocity  determined  by  the 
Lambert  routine  to  intercept  the  offset  target  in  a conic  gravity  field  is 
identical  to  the  velocity  required  to  intercept . the  true  target  in  the  non- 
Keplerian  field. 

The  traditional  technique  of  predicting  the  effects  of  gravitational  pertur- 
bations over  the  trajectory  involves  approximating  the  maneuver  by  an  impulsive 
velocity  change,  and  hence  assuming  a coasting  trajectory  between  the  initial 
(ignition)  and  target  positions.  However,  due  to  the  non-zero  length  of  the  maneu- 
ver, the  actual  trajectory  will  not  follow  the  path  predicted  by  the  impulsive 
approximation,  but  rather  a neighboring  path.  The  difference  in  the  perturbing 
acceleration  between  the  two  paths  accumulates  over  the  entire  trajectory,  re- 
sulting in  a miss  at  the  target.  Since  the  coasting  portion  of  the  trajectory  is 
generally  much  longer  than  the  thrusting  portion,  it  is  important  to  accurately 
predict  the  perturbing  effects  over  this  portion  of  the  trajectory.  This  is  accom- 
plished by  determining  the  initial  conditions  for  a coasting  trajectory  which  is 
coincident  with  the  actual  trajectory  after  thrust  termination.  A detailed  deriva- 
tion of  this  technique  can  be  found  in  Brand  (1971)  (Reference  1),  and  a functional 
description  of  the  procedure  follows. 
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NOMENCLATURE 


a,^.  Estimated  magnitude  of  the  thrust  acceleration 

d Number  of  columns  of  navigation  filter  weighting  matrix  (set  to  0 in 

this  routine  since  the  matrix  is  not  required) 


f 

fACS 

fOMS 


— N 


m 


n 


n 

max 

nrev 


r' 


Thrust 

Magnitude  of  the  attitude  control  system  translational  thrust 

Magnitude  of  the  nominal  orbital  maneuvering  system  engine 
thrust 

Unit  normal  to  the  trajectory  plane  (in  the  direction  of  the 
angular  momentum  at  ignition) 

Current  estimated  vehicle  mass 

Iteration  counter 

Iteration  limit 

Integral  number  of  complete  360°  revolutions  to  be  made  in 
the  desired  transfer 

Initial  (ignition)  position 

Adjusted  initial  position  used  to  define  coasting  trajectory 
Target  position  (input  to  the  routine) 

Terminal  position  (output  of  the  routine) 


r^c  Offset  target  position 


s Switch  set  in  the  Lambert  routine  to  indicate  transfer  is  near 

cone  , ;;  : 

180°  (see  Reference  4 for  complete  description) 


9. 7. 1.2  Precision  (continued) 


eng 


fail 


guess 


spert 


s 

pro] 


Ssoln 


^0 


3) 


-lc 


-i 


1 guess 


Engine  select  switch 

Switch  set  to  indicate  non- convergence 

Switch  set  to  indicate  an  estimate  of  independent  variable  r 
will  be  input  to  the  Conic  Required  Velocity  Determination 
Routine 

Switch  set  to  indicate  which  perturbing  accelerations  should  be 

included  in  the  offset  target  calculation  (s  , = 0 indicates 

pert 

only  conic  calculations;  see  Reference  3 for  complete  descrip- 
tion of  other  switch  settings) 

Switch  set  when  the  target  vector  must  be  projected  into 
the  plane  defined  by  _i 

Switch  indicating  which  of  two  physically  possible  solutions 
is  desired  in  the  multi -revolution  transfer  (see  Reference  4 
for  complete  description) 

Igpition  time 

Target  time  of  arrival 

Initial  (ignition)  velocity 

Initial  (and  required)  velocity  on  the  coasting  trajectory 
Terminal  velocity  of  a conic  trajectory 
Terminal  velocity  (output  of  the  routine) 

Guess  of  the  independent  variable  T used  in  the  Conic  Required 
Velocity  Determination  Routine 


Target  miss  resulting  from  perturbations 

Out-of-plane  target  miss  due  to  projection  of  the  target 
vector 
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9. 7. 1.2  Precision  (continued) 


At  Transfer  time  (t^  - t^) 

AVq  Required  velocity  change 

Magnitude  of  the  required  velocity  change 

AV0 

econv  Convergence  criterion;  target  miss  of  the  numerically  integrated 

trajectory 


e Tolerance  criterion  establishing  a cone  around  the  minus 

0 1 

r q direction  inside  of  which  the  target  vector  will 
be  projected  into  the  planed^  = s*n  cone  angle)J 

0 Transfer  angle  (true  anomaly  difference)  at  the  start  of  the 

thrusting  maneuver  ■ 

...  •.  ' » f v ' 

0T  Approximate  central  angle  traversed  during  the  thrusting  maneuver 


0^  Approximate  transfer  angle  to  the  target  at  the  termination 

of  the  thrusting  maneuver  Je^  = 0 - 0Tj 

oj  Approximate  orbital  rate  , 
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9. 7. 1.2  Precision  (continued) 


2.  FUNCTIONAL  FLOW  DIAGRAM 

A functional  flow  diagram  describing  the  calculations  necessary  to 
determine  the  precision  required  velocity  and  offset  target  is  presented  in  Figure 
1.  Since  this  technique  compensates  for  the  non-impulsive  nature  of  the  maneuver, 
it  requires  an  estimate  of  the  expected  thrust  acceleration.  Then  the  initial 
position  can  be  offset  from  the  actual  position  such  that  a coasting  trajectory 
which  is  coincident  with  the  actual  trajectory  after  thrust  termination  can  be 
defined.  Figure  2 illustrates  the  concept. 

The  calculation  of  the  coasting  trajectory  initial  position  requires  an 
estimate  of  the  required  velocity  change,  and  therefore  two  passes  are  made 
through  the  Lambert  routine  before  numerically  integrating  to  determine  the 
effects  of  gravitational  perturbations.  The  first  Lambert  solution  is  used  to 
determine  the  impulsive  velocity  change  required.  Based  upon  this,  an  estimate 
of  the  initial  position  for  the  coasting  trajectory  can  be  calculated.  Then  the 
second  Lambert  solution  determines  the  velocity  required  from  the  adjusted  initial 
position,  thus  defining  the  coasting  trajectory. 

For  transfers  angles  which  are  odd  multiples  of  180°,  Lambert's  problem 
has  a partial  physical  singularity  in  that  the  plane  of  the  transfer  becomes  inde- 
terminate. A detailed  description  of  this  singularity  can  be  found  in  Reference  4. 
To  prevent  possible  problems  in  both  targeting  and  guiding  a maneuver  whose 
transfer  angle  lies  near  this  singularity,  logic  has  been  included  in  this  routine 
to  determine  whether  the  transfer  angle  approaches  this  singularity  at  any  time 
during  the  maneuver.  If  this  is  the  case,  the  target  vector  is  projected  into  the 
orbital  plane  defined  by  the  premaneuver  position  and  velocity,  thus  preventing 
any  plane  change. 

If  only  conic  calculations  are  desired,  the  routine  is  exited  after  the  two 
Lambert  solutions  are  completed.  If  not,  subsequent  numerical  integration  de- 
termines the  target  miss  resulting  from  the  effects  of  gravitational  perturbations 
over  this  path.  To  compensate  for  these  effects,  the  target  vector  for  the  Lambert 
routine  is  offset  from  the  actual  target  by  the  negative  of  the  miss  vector.  Since 
the  adjusted  initial  position,  target  offset,  and  effects  of  gravitational  perturba- 
tions are  all  interdependent,  the  process  is  repeated  until  changes  in  the  offset 
target  position  are  small  enough  to  indicate  convergence.  Three  passes  (two 
iterations)  are  normally  sufficient  to  establish  the  offset  within  a few  feet. 
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9. 7. 1.2  Precision  (continued) 


Figure  lb.  Functional  Flow  Diagram 
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9. 7. 1.2  Precision  (continued) 
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Figure  2.  Coasting  Trajectory  Illustration 


9. 7. 1.2  Precision  (continued) 


3.  INPUT  AND  OUTPUT  VARIABLES 

Input  Variables 

tg  Ignition  time 

£g,  Vg  State  vector  at  ignition  time  tg 

t^  Target  time  of  arrival 

r,  Target  position  vector 

m Estimated  vehicle  mass 

nrev  Integral  number  of  complete  360°  revolutions  to  be  made  in  the  desired 
transfer 

ssoln  Switch  indicating  which  of  two  physically  possible  solutions  is  desired 
in  the  multi -revolution  transfer  (see  Reference  4) 

seng  Engine  select  switch 

spert  Switch  set  to  indicate  which  perturbation  accelerations  are  desired  to  de- 
termine required  velocity  on  the  coasting  trajectory  (spert  = 0 indicates  conic  only) 

Output  Variables 

Initial  position  and  velocity  vectors  on  the  coasting  trajectory  (differencing 
Vg  and  the  premaneuver  velocity  provides  a precise  measure  of  the 
required  velocity  change) 

£{<  Position  and  velocity  at  time  t^  resulting  from  the  maneuver  (includes 

the  effects  of  projection  into  the  orbital  plane  if  required) 
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— lc*  Offset  target  position  (identical  to  when  only  conic  calculations  are 

desired)  --  - • : ’•  ' ' 

Unit  normal  to  the  premaneuver  orbital  plane 


s .*  Switch  set  to  indicate  that  the  transfer  angle  is  near  an  odd  multiple  of  180° 
pro]  6 

and  therefore  the  target  has  been  projected  into  the  premaneuver  orbital 
plane 


Ar, 


pro] 


Out-of-plane  target  miss  due  to  projection  of  the  target  vector  into  the 


premaneuver  orbital  plane  (Ar 


pro] 


0 when  projection  is  unnecessary) 


Sfaii  Switch  set  if  convergence  difficulties  are  encountered  in  the  iterative 
scheme  used  to  compensate  for  gravitational  perturbations  (sfaij  = 0 
indicates  no  convergence  difficulties) 


* These  outputs  are  required  by  the  powered  flight  guidance  to  perform  the 
Lambert  aimpoint  maneuver. 
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9. 7. 1.2  Precision  (continued) 


4.  DESCRIPTION  OF  EQUATIONS 


The  computational  process  used  to  calculate  a precision  required 
velocity  and  offset  target  makes  extensive  use  of  the  Conic  Required  Velocity 
Determination  Routine  (Lambert  routine)  and  the  Precision  State  Extrapolation 
Routine  (coasting  integration).  The  calculation  of  the  precision  required  velocity 
requires  at  least  two  Lambert  solutions  so  that  the  concept  of  a coasting  trajectory 
can  be  used  to  compensate  for  the  finite  length  of  the  maneuver.  In  addition, 
if  an  offset  target  is  desired  to  compensate  for  gravitational  perturbations  a 
straight  forward  iterative  technique  involving  successive  Lambert  solutions 
followed  by  precision  integration  is  used.  Since  these  techniques  are  described 
in  Section  2,  the  remainder  of  this  section  will  discuss  the  treatment 
of  the  singularity  in  the  Lambert  solution  for  transfer  angles  which  are  odd 
multiples  of  180°  . 

The  reader  should  be  familiar  with  the  discussion  in  subsection  4.  7 
of  Reference  4.  From  that  discussion,  it  is  evident  that  if  the  initial  and 
target  position  vectors  used  to  define  the  transfer  plane  are  nearly  colinear, 
small  changes  in  either  of  these  position  vectors  can  cause  large  changes  in 
the  transfer  plane.  However,  even  small  changes  in  the  transfer  plane  cause 
large  changes  in  the  required  Av.  Thus  during  the  targeting  process,  when 
successive  solutions  of  Lambert's  problem  are  necessary,  the  adjustments 
being  made  to  the  initial  and  target  positions  can  result  in  radically  different 
transfer  planes.  Likewise,  during  the  powered  maneuver,  out-of-plane  thrust 
transients  can  cause  changes  in  the  initial  position  which  substantially  alter 
the  transfer  plane. 

Since  plane  change  maneuvers  are  most  efficiently  performed  when 
the  transfer  angle  to  the  target  is  90  or  270  degrees,  it  is  not  practical  to  make 
plane  changes  when  the  transfer  angle  is  near  180  degrees.  To  prevent  costly 
plane  changes,  therefore,  logic  has  been  included  in  both  the  Lambert  routine  and 
this  routine  to  force  the  solution  into  the  premaneuver  orbital  plane,  which  is 
defined  by  the  unit  normal  i_N . During  the  targeting  process  this  routine  deter- 
mines whether  the  transfer  angle  during  the  maneuver  is  likely  to  lie  in  the  re- 
gion of  180  degrees  (or  540,  900,  etc. ).  If  this  is  the  case,  the  switch  s . is 

pro] 

set.  This  forces  all  solutions  of  Lambert's  problem  for  this  maneuver  (both  for 
this  routine  and  the  powered  flight  guidance)  to  be  based  on  initial  and  target 
positions  which  have  been  projected  into  the  premaneuver  orbital  plane. 
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Since  target  vectors  for  Lambert  transfers  in  the  region  of  180  de  - 
grees  should  logically  be  limited  to  the  premaneuver  orbital  plane,  this  projec- 
tion should  have  no  effect.  However,  during  the  process  of  calculating  an  offset 
target,  numerical  integration  may  indicate  an  out-of  -plane  target  miss  due  , 
to  gravitational  perturbations.  Normally,  compensation  for  this  is  accomplished 
by  an  offset  target  equivalently  out-of-plane  in  the  opposite  direction.  Near 
the  180  degree  singularity,  however,  this  would  cause  large  changes  in  the  trans- 
fer plane.  Therefore  when  the  switch  Sproj  is  set,  indicating  transfers  near 
the  singularity,  no  compensation  for  the  out-of-plane  effects  of  gravitational 
perturbations  is  allowed  (or  practical).  In  this  case  compensation  is  limited 
to  in-plane  effects  and  accomplished  by  an  in-plane  offset  target.  The  out-of- 
plane  miss  Ai~proj  resulting  from  this  technique  is  returned  to  the  calling  routine 
for  possible  display. 


During  initialization  of  this  routine,  the  switch  s . is  set  to  zero. 

proj 

After  every  Lambert  solution,  tests  are  made  to  determine  if  the  transfer  angle 
will  lie  near  the  singularity  during  the  maneuver.  If  transfers  near  the  singular- 
ity are  detected,  the  switch  s . is  set  and  the  routine  is  reinitialized,  thus 

proj 

'locking'  all  subsequent  solutions  into  the  premaneuver  orbital  plane. 


To  determine  if  the  transfer  angle  will  lie  near  the  singularity  during 

the  maneuver,  the  logic  described  by  Figure  3b  of  the  Detailed  Flow  Diagram 

is  used.  First  the  switch  s . is  checked  to  see  if  previous  solutions  have 

proj 

indicated  the  transfer  will  lie  near  the  singularity.  If  it  is  not  set,  then  the  switch 

Scone*  returned  by  the  Lambert  routine,  will  indicate  whether  the  transfer  angle 

0 at  ignition  lies  in  a small  cone  about  the  singularity.  If  s is  not  set, 

cone 

it  is  still  necessary  to  determine  if  the  transfer  angle  is  likely  to  move  into  the 
region  of  the  singularit  y during  the  maneuver.  To  accomplish  this,  the  central 
angle  0T  traversed  during  the  maneuver  is  estimated  by  multiplying  the  approxi- 
mate maneuver  time  (Av/a^.)  by  the  approximate  orbital  rate  (v0/rQ).  Then 
the  transfer  angle  0 ^ remaining  at  the  completion  of  the  maneuver  can  be  tested 
(0^  - 0 - 0T).  If  0^  lies  near  the  singularity,  defined  by  the  sine  of  the  half 
cone  angle  €0^.,  the  switch  spr.0j  is  set  and  the  routine  is  reinitialized. 


9.7-61 


9. 7. 1.2  Precision  (continued) 


5.  DETAILED  FLOW  DIAGRAM 


This  section  contains  a detailed  flow  diagram  of  the  routine  for  deter- 
mining the  required  velocity  and  target  offset. 

Each  input  and  output  variable  in  the  routine  and  subroutine  call  state- 
ments can  be  followed  by  a symbol  in  brackets.  This  symbol  identifies  the  nota- 
tion for  the  corresponding  variable  in  the  detailed  description  and  flow  diagrams 
of  the  called  routine.  When  identical  notation  is  used,  the  bracketed  symbol  is 
omitted. 
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Figure  3a.  Detailed  Flow  Diagram 
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Figure  3c.  Detailed  Flow  Diagram 
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6.  SUPPLEMENTARY  INFORMATION 


The  scheme  presented  here  for  predicting  and  compensating  for 
gravitational  perturbations  is  slightly  different  from  the  APOLLO  design.  How- 
ever, the  performance  is  considerably  improved  and  the  ideas  are  compatible 
with  the  Powered  Flight  Guidance  Routines  proposed  in  Reference  2,  which  also 
utilize  the  concept  of  a coasting  trajectory  to  advantage.  The  treatment  of  the 
180  degree  Lambert  singularity  has  also  been  improved. 

The  convergence  tolerance  is  yet  to  be  determined,  but  should  be 
consistant  with  orbital  navigation  accuracy.  It  should  be  noted  that  because  of 
the  sequence  of  computations  in  this  routine,  a tolerance  of  1000  feet  can  result 
In  an  actual  error  of  about  10  feet  since  experience  has  shown  that  the  target  miss 
resulting  from  numerical  integration  (and  the  corresponding  incremental  im- 
provement in  the  target  offset)  decreases  by  a factor  of  about  1/100  per  iteration. 
An  iteration  limit  was  included  since  any  iterative  loop  should  have  some  contin- 
gency exit  in  the  event  of  non-convergence. 
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SPACE  SHUTTLE 


GN&C  SOFTWARE  EQUATION  SUBMITTAL 
Software  Equation  Section:  Powered  Flight  Guidance 

Submittal  No.  25A 

Function:  To  issue  proper  steering  and  engine  cutoff  commands  so  as 

to  satisfy  desired  maneuver  cutoff  conditions. 

Mosule  No.  0G2 Function  No.  2.4.5  & 6 (MSC  03690) 

Submitted  by:  Pu.  Higgins . & Brand  Co.  MIT  No.  11  (Rev.  1) 
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NASA  Contract:  C.  Lively  Organization:  EG2 

Approved  by  Panel  III:  K.3~.  -<  Date:  1 ll  I 

Summary  Description:  This  routine  augments  the  Apollo  External  Delta-V 

Maneuver  Guidance  Mode  and  the  Apollo  Lambert  Aim-Point  Maneuver  Mode 

with  (1)  guidance  during  the  maneuver  based  on  navigation  in  a spherical 
gravity  field,  and  (2)  required  velocity  determined  in  consideration  of 
a finite  maneuver  length.  These  additions  considerably  improve  the  ac- 
curacy of  the  maneuvers.  This  revision  provides  (1)  equations  required 
to  explicity  control  re-entry  angle  for  deorbit  maneuvers  and  (2)  logic 
to  avoid  difficulties  for  transfer  angles  near  180°. 

Comments:  P30  (Apollo)  External  AV  Maneuver  Guidance  is  included  as  a 
subset  of  this  submittal  and  can  be  removed  from  Appendix  A of  Volume  III. 
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(Verification  Status)  __________ 

Panel  Comments: 
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1.  INTRODUCTION 

The  objective  of  the  Powered  Flight  Guidance  Routines  is  to  issue  the  proper 
steering  and  engine  cutoff  commands  such  that  the  desired  terminal  conditions  of  the 
maneuver  are  satisfied.  The  basic  powered  flight  guidance  law  used  in  the  orbiter  is 
a velocity-to-be-gained  concept  with  cross-product  steering. 

The  two  principle  modes  of  the  Powered  Flight  Guidance  Routines  are:  .. 

1.  Delta- V Maneuver  Guidance  Mode 

2.  Real-Time  Required  Velocity  Up- 
dating Guidance  Mode. 

The  Delta-V  Maneuver  Guidance  Mode  is  essentially  equivalent  to  the 
External  Delta-V  Maneuver  Guidance  Mode  used  in  APOLLO.  The  input  desired 
velocity  change  is  modified  to  compensate  for  the  estimated  central  angle  to  be 
traversed  during  the  maneuver.  Then  the  object  of  the  powered  phase  is  simply  to 
steer  the  vehicle  to  achieve  this  velocity  change. 

The  Real-Time  Required  Velocity  Updating  Mode  is  a generalized  version 
of  the  Lambert  Aim  Point  Maneuver  Mode  used  in  APOLLO.  The  object  of  these 
maneuvers  is  to  place  the  vehicle  on  a coasting  trajectory  which  will  intercept  a 
specified  target  at  a specified  time.  Two  new  concepts  which  greatly  improve  the 
accuracy  of  these  maneuvers  are  introduced.  First,  guidance  during  the  maneuver 
is  based  on  a state  vector  navigated  from  ignition  in  a spherical  (Keplerian)  gravity 
field.  Second,  the  required  velocity  is  not  determined  using  the  present  vehicle 
position  but  rather  an  offset  position  which  accounts  for  the  finite  length  of  the  ma- 
neuver. Since  this  is  primarily  an  equations  document,  these  new  concepts  are 
treated  only  briefly  in  the  text.  A detailed  description  and  derivation  can  be  found 
in  Reference  5. 

Because  the  calculation  of  required  velocity  can  be  a lengthy  process,  the 
ability  to  update  the  required  velocity  every  major  cycle  is  dependent  upon  the  speed 
of  the  computer.  The  APOLLO  Guidance  Computer  required  portions  of  several 
major  cycles  to  complete  the  solution.  The  guidance  equations  described  here  will 
assume  that  the  orbiter  computer  will  also  need  portions  of  several  major  cycles  to 
complete  the  solution  for  required  velocity.  A faster  computer  would  not  alter  the 
basic  concepts  presented  here,  but  would  simplify  the  mechanization  somewhat. 

The  Real-Time  Required  Velocity  Updating  Mode  may  select  a specific 
required  velocity  routine  to  accomplish  one  of  the  following  maneuvers: 


/ 

I; 

i. 
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1.  Lambert  Aim  Point  Maneuver 

2.  Deorbit  Maneuver 

3.  Other  maneuvers  such  as  a maneuver  to  an 
orbit  with  certain  specified  constraints  (TBD). 

The  required  velocity  routines  will  be  subjects  of  separate  documents. 
Since  this  report  is  mainly  concerned  with  the  documentation  of  guidance  equations, 
logic  or  computations  concerned  with  monitoring  or  controlling  system  operation 
will  not  be  presented. 
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NOMENCLATURE 


a^.  Estimated  magnitude  of  thrust  acceleration 

C Matrix  to  rotate  the  target  vector  to  compensate 

for  earth  rotation  due  to  change  in  time  of  flight 
during  deorbit  maneuver 

d Dimension  of  navigation  filter  weighting  matrix  (d  = 0 

in  this  routine  since  the  matrix  is  not  used) 

f Thrust 

foMS  Magnitude  of  orbital  maneuvering  system  engine 

thrust 

f Magnitude  of  attitude  control  system  engine  trans- 

lational thrust 

g Gravity  vector  in  the  oblate  gravity  field 

gg  Gravity  vector  in  the  spherical  gravity  field 

_i  n Unit  vector  in  the  direction  of  the  angular  momentum 

vector  normal  to  the  transfer  plane 


i ,i  .i 

-x  -y  -z 


-TD 


' steer 


‘tgo 


Unit  vectors  of  local  vertical  coordinates 

Unit  vector  of  desired  thrust  direction 

Sensitivity  used  in  computing  the  desired  change 
in  flight  time  to  control  entry  angle  during  deorbit 

Steering  gain 


Intermediate  variable  in  t computation 

go 


Current  estimated  vehicle  mass 


Number  of  guidance  cycles  used  in  thrust 
acceleration  magnitude  filter 
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N 


Integer  number  of  360  revolutions  used  in 
Conic  Required  Velocity  Determination  Routine 

Normalized  semi-latus  rectum  of  conic 
transfer  orbit 


Parameter  defining  the  desired  terminal  flight 
path  angle 

Parameter  defining  the  projected  terminal 
flight  path  angle 

Position  vector  navigated  in  the  oblate  gravity 
field 


— s 


r(t2) 


A r 


cone 


cut-off 


guess 


Position  vector  on  the  coasting  trajectory 

Position  vector  navigated  in  the  spherical 
gravity  field 

Offset  target  vector  at  t 2 
Initial  position  offset 

Switch  in  the  Conic  Required  Velocity  Deter- 
mination Routine  to  indicate  if  the  transfer  is 
near  180°  (see  Ref.  3 for  details) 

Engine  cut-off  switch 


command  not  issued 
command  issued 


Switch  to  indicate  whether  estimate  of  independent 
variable  T will  be  input  to  the  Conic  Required  Ve- 
locity Determination  Routine  (see  Ref.  3 for  details) 
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eng 


enable 


Engine  select  switch 
Steering  enable  switch 


I = 0 inhibit  \ 

\=  1 enable  ) 


pert 


Switch  indicating  the  perturbing  accelerations 
to  be  included  in  Precision  State  and  Filter 
Weighting  Matrix  Extrapolation  Routine  (see 
Ref.  2 for  details) 


proj 


soln 


Switch  indicating  whether  the  initial  and  target 
position  vectors  are  to  be  projected  into  the  plane 
defined  by  _iN  (see  Ref.  6 for  details) 

Switch  indicating  which  of  two  possible  solutions 
is  desired  in  the  multi-revolution  case  (see  Ref. 

3 for  details) 


steer 


Steering  switch 


no  steering 

active  steering  permitted 


Current  state  vector  time  (during  thrusting  phase, 
this  is  the  time  at  which  the  accelerometers  are  read) 


At 

At 

At 

At 


cut-off 


enable 


Guidance  cycle  time  step 
Dummy  transfer  time  set  to  0 


Value  of  t used  to  define  time  to  issue  engine  cut- 
off command  and  terminate  active  steering 

Value  of  t which  distinguishes  between  long  or 
short  maneuver 


At 


to 


Time  interval  before  t.  to  start  thrusting  phase 
computations 


At 


t 1 


Time  interval  prior  to  t.  when  initial  t predic- 

ig  go 

tion  is  made 
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At  t 2 Time  interval  after  t.  when  steering  is  permitted 

At  ta^-off  Time  interval  representing  the  duration  of  a burn 

at  maximum  thrust  equivalent  to  the  tail-off  impulse 
after  the  engine-off  signal  is  issued 

At  tail-off  At  tail-off  of  orbital  maneuvering  system  engine 

OMS 


At  tail-off  At tail-off  of  attitude  control  system  engine  for 
ACS  translational  maneuver 


6 tg  Change  in  time  of  arrival  required  to  satisfy  ter- 

minal flight  path  angle  in  a deorbit  maneuver 


t 

t 


2 


go 


ig 


v 


Time  of  arrival  at  £^2) 

Time-to-go  before  engine  cut-off 
Nominal  engine  ignition  time 

Velocity  vector  navigated  in  the  oblate  gravity  field 

Velocity  vector  navigated  in  the  spherical  gravity 
field 


Vg  Velocity-to-be-gained  vector 

Vg  Magnitude  of  v^ 

v'req  Required  velocity  vector  at  the  offset  initial  posi- 

tion (defines  the  coasting  trajectory) 

v Required  velocity  at  current  position  (no  initial 

position  offset) 

Av  Measured  velocity  increment  vector  due  to 

thrust  in  one  guidance  cycle 

Av  Magnitude  of  Av 
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A v Input  desired  velocity  change  vector  to  Delta- V 

Guidance  Mode 

Avxz  In-plane  components  of  Av^y 

Av  Compensated  in-plane  components  of  Av. 

— ■ C — l—j  V 

Av  , Av  , 

x ^ Components  of  Av  j^y 
z 

Vexh  Exhaust  velocity 

vexh’OMS  Exhaust  velocity  of  the  orbital  maneuvering 
system  engine 

vexh  ’ ACS  Exhaust  velocity  of  the  attitude  control  system 
engine  for  translational  maneuver 

Reciprocal  of  normalized  semi-major  axis  of 
conic  transfer  orbit 

e._  Tolerance  criterion  establishing  a cone 

0 Or 

around  the  negative  target  position  di- 
rection inside  of  which  the  Conic  Required 
Velocity  Determination  Routine  will  define 
the  transfer  plane  by  _i^ 

Yt2  Projected  terminal  flight  path  angle  with  respect 

to  local  horizontal  (negative  downward) 

T Converged  value  of  iteration  variable  used  in  Conic 

Required  Velocity  Determination  Routine 

Tp  Previous  value  of  r 

Estimated  value  of  T 
Time  rate  of  change  of  T 
Ratio  of  |r(t2)|  to  |r(t)| 

Estimated  central  angle  during  thrusting  maneuver 
in  Delta-V  Guidance  Mode 

H Earth's  gravitational  constant 


r 

guess 

T 
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T 


t o 

earth 


Time  associated  with  current  required  velocity 

Previous  value  of  r 

Angular  velocity  command 

Magnitude  of  the  earth's  angular  velocity 
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2.  FUNCTIONAL  FLOW  DIAGRAM 


Powered  Flight  Guidance  involves  both  the  prethrust  and  thrusting  phases 
of  the  maneuver.  The  prethrust  computations,  shown  in  Figure  1,  are  a single  step 
process  performed  several  minutes  prior  to  the  maneuver  to  prepare  the  vehicle 
for  thrusting.  They  are  required  to  process  targeting  parameters  to  determine  the 
desired  vehicle  attitude  at  ignition.  In  addition,  the  state  vector  is  advanced  to  a 
specified  time  prior  to  ignition.  At  this  time,  an  integral  number  of  major  cycles 
prior  to  ignition,  the  thrusting  phase  computations,  including  Powered  Flight 
Navigation,  are  initiated.  Of  course,  the  attitude  maneuver  necessary  to  align  the 
vehicle  to  the  desired  attitude  at  ignition  should  be  completed  before  entering  the 
thrusting  phase  computations. 

The  sequence  of  functions  performed  during  the  powered  flight  phase  is 
illustrated  in  Figure  2.  The  guidance  computer  program  known  as  the  Servicer 
Routine,  which  controls  the  various  subroutines  to  create  a powered  flight  sequence, 
is  not  included  in  this  document. 

Each  guidance  cycle  begins  with  the  reading  of  the  accelerometers  and  is 
followed  by  the  updating  of  the  state  vector  in  the  Powered  Flight  Navigation  Routine. 
Then  the  velocity-to-be-gained  is  updated  in  the  Cross-Product  Steering  Routine. 

If  steering  is  permitted,  the  latter  also  computes  the  time-to-go  and  the  steering 
command  beginning  at  a fixed  time  after  ignition. 

The  targeting  calculations  used  to  predict  and  compensate  for  gravitational 
perturbations  establish  an  offset  target  which  assumes  that  the  vehicle  is  under 
the  influence  of  only  a spherical  gravity  field  after  the  expected  ignition  time.  There- 
fore, in  the  Real-Time  Required  Velocity  Updating  Mode,  it  is  necessary  to  maintain 
an  additional  state  vector  navigated  in  a spherical  gravity  field.  This  dual  naviga- 
tion should  begin  at  the  ignition  time  assumed  in  the  targeting  program  if  it  differs 
from  the  actual. 

Figure  2 shows  the  sequencing  of  the  main  branch  of  the  guidance  routine 
during  the  thrusting  phase.  In  the  Real-Time  Required  Velocity  Mode,  another 
branch  of  the  Powered  Flight  Guidance  Routines  involving  the  calculation  of  re- 
quired velocity  operates  as  a separate  branch  independent  of  the  main  guidance 
cycle.  This  separate  branch,  called  the  Velocity-to-be-Gained  Routine, 
is  initiated  and  controlled  by  the  Servicer  Routine  and  may  require  portions  of 
several  major  guidance  cycles  to  complete  its  solution.  Of  course,  simple  velocity- 
to-be-gained  updates  computed  by  decrementing  the  previous  value  by  the  sensed 
velocity  change  continue  in  the  Cross-Product  Steering  Routine  every  major  cycle. 
Normally,  the  Velocity-to-be-Gained  Routine  operates  on  a lower  priority  than  the 
main  guidance  loop  so  that  the  new  velocity-to-be-gained  vector  is  not  used  by  the 
Cross-Product  Steering  Routine  until  the  next  guidance  cycle. 
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ENTER 


Figure  1.  Powered  Flight  Program 


9.7.3  Guidance  (continued) 


ENTER 


EXIT 

Figure  2.  Powered  Flight  Guidance  Routines 
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The  characteristic  of  the  transfer  in  the  Real-Time  Required  Velocity 
Updating  Mode  in  relation  to  the  singularity  cone  of  the  Lambert  problem  is  deter- 
mined by  the  targeting  program  before  the  powered  phase  is  initiated.  This  in- 
formation is  passed  on  to  this  guidance  program  through  the  sprQ.  switch  and  is 
used  by  the  Conic  Required  Velocity  Determination  Routine  to  define  the  transfer 
plane.  (See  Ref.  3 for  a detailed  explanation  of  the  singularity  cone  and  Ref.  6 
for  the  targeting  procedure). 


If  the  s . switch  has  been  set,  the  transfer  will  take  place  in  the  plane 
proj 

defined  by  the  unit  vector  _iN  in  the  direction  of  the  angular  momentum  vector  at 
ignition.  If  this  switch  has  not  been  set,  there  are  two  possibilities.  Under  normal 
circumstances  the  transfer  will  take  place  in  the  plane  defined  by  the  vehicle  and 
target  position  vectors.  However,  unexpected  degradation  in  engine  performance 
during  flight  may  prolong  the  powered  maneuver  to  such  an  extent  that  the  input 
position  vector  to  the  Conic  Required  Velocity  Determination  Routine  is  inside  the 
singularity  cone.  The  procedure  to  cope  with  this  situation  is  presented  below. 


If  the  s . switch  has  not  been  set  by  the  targeting  program,  the  s 

proj  cone 

switch,  which  is  an  output  of  the  Conic  Required  Velocity  Determination  Routine, 
is  checked  at  each  guidance  cycle.  If  it  is  found  that  this  switch  has  been  set. 
indicating  that  the  input  position  vector  is  inside  the  singularity  cone,  the  Servicer 
Routine  is  directed  to  bypass  the  Velocity-to-be-gained  Routine  for  the  remainder 
of  the  powered  maneuver.  In  other  words,  the  remaining  powered  maneuver  will 
be  completed  simply  by  decrementing  the  previous  value  of  the  velocity-to-be- 
gained  by  the  sensed  velocity  change  as  is  done  in  the  Delta- V Mode. 


When  the  time-to-go  becomes  less  than  some  predetermined  value, 
active  steering  is  suspended  and  an  engine  cut-off  command  is  set  to  be  issued  at 
the  proper  time. 
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3.  INPUT  AND  OUTPUT  VARIABLES 


Input  Variables 


t . 
ig 

m 


Current  time  of  the  state  vector 


r(t),  v(t)  Current  state  vector 


Nominal  ignition  time 
Current  estimated  vehicle  mass 


eng 


Engine  select  switch 


s pert 


Switch  indicating  if  certain  perturbations 
should  be  included  in  Precision  State  Extra- 
polation (see  Ref.  2) 


Delta-V  Mode: 

Av  Input  desired  velocity  change  vector  in 

local  vertical  coordinates 


Real-Time  Required  Velocity  Updating  Mode: 


-N 

Unit  vector  in  the  direction  of  angular 
momentum  normal  to  the  transfer  plane 

py 

Parameter  defining  desired  terminal  flight 
path  angle  in  a deorbit  maneuver 

n 

rev 

Integer  number  of  complete  360°  revolutions 
to  be  made  in  the  desired  transfer 

r(t2) 

Offset  target  vector  at  time  tg 

s 

proj 

Switch  indicating  whether  the  initial  and  target 
position  vectors  are  to  be  projected  into  the 
plane  defined  by  i ^ 

s soln 

Switch  indicating  which  of  two  physically 
possible  solutions  is  desired  in  the  multi- 
revolution case 

9.7.3  Guidance  (continued) 


e Tolerance  criterion  establishing  a cone 

6 Cj 

inside  which  the  Lambert  routine  will  define 
the  plane  of  transfer  by  -N  ( = sine 

of  one-half  of  the  cone  angle  ) 

Output  Variables 


to  Angular  velocity  command  in  inertial  coordinates 

Engine  cut-off  Command 
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DESCRIPTION  OF  EQUATIONS 


The  Powered  Flight  Guidance  Routines  have  two  major  phases,  the  prethrust 
phase  and  the  powered  flight  phase. 

4.  1 Prethrust  Phase 


4.  1.  1 Delta-V  Mode 

The  position  and  velocity  vectors,  r (t)  and  v(t),  are  extrapolated  to  t. 
using  the  Precision  State  Extrapolation  Routine  described  in  Reference  2. 


The  local  vertical  coordinate  system  at  ignition  is  defined  by  the  unit  vectors 
as  follows : 


i = 

— X 

unit 

{t£<*lg>X 

V (t  . 

- Ig 

i = 

-y 

unit 

[ v(tig)  X 

r (t  . 

- ig 

i = 

-z 

- unit 

[£<tig>]- 

The  Prethrust  Routine  accepts  an  input  Av  in  local  vertical  coordinates 


A£LV  = ( Avx'  Avy*  AVzK 


The  in  plane  components  of  Av  in  inertial  coordinates  are  given  by 


Av  = Av  i + Av  i 
— XZ  X -X  z -z 


The  estimated  central  angle  traversed  by  the  vehicle  during  the  powered 
maneuver  is  computed  from 


r (t  ) X v(t.  ) avlv  m 


r (V  f 
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The  in  plane  components  of  Av  are  then  rotated  by  half  of  the  estimated 
central  angle,  as  shown  in  Figure  3,  to  give 


Av, 


Av 


unit  (Av  ) cos 
— xz 


($) 


+ unit  ( Av  x i ) sin 
xz,  -y 


The  total  compensated  velocity-to-be-gained  vector  at  t.  is 
v (t  . ) = Av  + Av  i 

-g  ig  “ c y £y 

and  the  unit  vector  of  the  desired  thrust  direction  is 


i TD  - unit  [ v (t  ,g) 


4.  1.  2 Real-Time  Required  Velocity  Updating  Mode 


The  following  discussion  of  the  prethrust  computations  necessary  in  the 
Real-Time  Required  Velocity  Updating  Mode  introduces  the  concept  of  defining  the 
required  velocity  on  a coasting  trajectory.  Since  a similar  set  of  equations  and  a 
more  complete  description  can  be  found  in  the  discussion  of  the  Velocity-to-be- 
Gained  Routine,  only  a brief  description  will  be  included  here. 


As  is  done  in  the  Delta-V  Mode,  the  first  step  in  the  prethrust  process  is 
the  extrapolation  of  the  position  and  velocity  vectors,  r(t)  and  v(t),  to  the  igni- 
tion time,  t . , using  the  Precision  State  Extrapolation  Routine  (Ref.  2).  The 
Conic  Required  Velocity  Determination  Routine  (Ref.  3)  is  called  to  compute  the 

required  velocity  at  ignition,  v (t.  ).  An  estimate  of  the  velocity-to-be- 

req  lg 

gained  vector  at  ignition,  v (t.  ) , based  on  an  impulsive  maneuver,  is  obtained 

s ig 
by 


v 

“g 


) 


V 

— req 


( t . ) - v ( t . 
ig  ~ ig 


) . 


This  estimate  of  velocity-to-be-gained  is  then  used  to  compute  an  initial  position 
offset,  A_r  ( .t  ^ ) , which  is  an  estimate  of  the  position  deviation  of  a coasting  tra- 
jectory from  the  finite-thrust  trajectory.  This  coasting  trajectory  is  coincident 
with  the  finite-thrust  trajectory  at  thrust  termination. 


A prethrust  estimate  of  the  thrust  acceleration,  also  required  to  compute 
the  offset,  is  given  by 


a 


T 


m ’ 
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Figure  3.  Compensation  of  In-plane  Components  of  Desired  Velocity 
Change  for  Estimated  Central  Angle  in  Delta-V  Maneuver 
Guidance  Mode 


9.7-85 


9.7.3  Guidance  (continued) 


where  f and  m are  the  nominal  thrust  and  current  estimated  vehicle  mass. 

Using  the  velocity-to-be-gained  and  thrust  acceleration  estimates,  the 
initial  position  offset  is  defined  by 


^(tig 


)=  - 


vft.  ) 
-g  ig 


and  the  initial  position  of  the  coasting  trajectory,  r1  (t  ) is  simolv 

- ig 

^'(tig)  = £<tig)  +Ar(tig). 


The  Conic  Required  Velocity  Determination  Routine  is  again  called  to 
compute  the  required  velocity,  v'req  (t  ) , from  the  offset  ignition  position. 

Then  the  final  value  of  velocity-to- be -gained  and  desired  thrust  direction  at  ignition 
are  given  by 


v ( t . ) = v1  ( t . ) - v ( t ) 
-gv  ig'  - req ' ig'  ig  ' 

1TD  = unit  [ vg(t.g>  ] . 


The  final  step  in  the  prethrust  phase  is  the  extrapolation  of  the  state  vector 
to  a predetermined  time  (t  -AttQ)  prior  to  ignition.  This  is  the  time  at  which 
the  thrusting  phase  calculations,  including  powered  flight  navigation,  are  initiated. 


4.  2 Powered  Flight  Phase 


4.  2.  1 Time-to-go  Prediction 


An  initial  estimate  of  the  duration  of  engine  thrust  is  required  to  determine 
if  active  steering  is  allowed.  The  computation  is  done  at  a predetermined  time 
before  ignition  using  vg(t  ) , and  estimated  mass  and  mass  flow  rate.  Any  cor- 
rection in  vg  due  to  ullage  prior  to  this  time  will  be  accounted  for  in  the  Cross- 
Product  Steering  Routine.  It  is  only  necessary  to  correct  v for  ullage  from  this 
time  on.  The  corrected  is  used  to  determine  certain  parameters  so  that  the 
maneuver  may  be  classified  as  either  short  or  long.  Active  steering  is  inhibited 
enable  ^ ^or  s*10r'-  maneuver.  In  this  case,  t gQ  is  computed  and  a cut- 
off command  is  issued  to  take  place  at  t .g  + t . Active  steering  is  permitted 
enable  = 1 * for  a long  maneuver  and  t is  not  computed. 


Detailed  t gQ  computation  for  short  burn  will  be  given  at  a later  date 
when  engine  characteristics  become  available. 
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4.  2.  2 Acceleration  Magnitude  Filter 

In  order  to  compute  an  initial  position  offset  vector  Ar  (t)  in  the  Velocity- 
To-Be-Gained  Routine,  an  estimate  of  the  thrust  acceleration  is  required. 

During  the  prethrust  phase,  an  estimate  of  a,p  is  given  by 

f 

aT  = — . 

T m 

This  value  is  also  used  during  the  powered  flight  phase  until  several  guid- 
ance cycles  after  actual  engine  ignition.  From  that  time  on,  aT  is  computed  by 
an  averaging  process  over  a number  of  guidance  cycles,  i.  e. , 

n lAv  • I 

a„  = 2 • 

T ^ n At 

i = 1 

The  minimum  number  of  guidance  cycles,  n,  required  to  smooth  out  fluctua- 
tion is  to  be  determined. 

4.  2.  3 Cross-Product  Steering  Routine 

The  first  function  of  the  Cross-Product  Steering  Routine  is  to  update  the 
velocity-to-be-gained  vector  by  subtracting  the  measured  velocity  change.  A v . 

Vg(t)  = v (t  - At)  - Av 


In  the  Delta- V Mode,  the  (t  - At)  is  the  v^  of  the  previous  guidance 
cycle.  However,  in  the  Real-Time  Required  Velocity  Updating  Mode,  this  term 
may  have  been  updated  by  the  Velocity-to-be-Gained  Routine  in  the  previous  guid- 
ance cycle. 

If  active  steering  is  enabled  (senab  = 1),  the  steering  switch 
s steer  is  Set  to  1 to  Permit  active  steering  at  a specified  time  after  actual  engine 
ignition  and  reset  to  0 when  t becomes  less  than  some  predetermined  value, 
Atcut-off ' When  ssteer  = 1 ’ tgo  is  comPuted  by  the  equation 


t 


go 


v ■ Av 
~g 

A v • Av 


At  + At 


tail-off  ’ 
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where 


k 

ego 


vexh 


A v 
aTv 


The  steering  command  computed  is  an  angular  velocity  command  in  inertial 
coordinates  and  is  given  by 


^c 


steer  v Av 
g 


It  may  be  required  that  the  actual  steering  command  to  the  autopilot  be  in 
the  navigation  base  coordinates  in  which  case  a coordinate  transformation 
of  will  be  required. 


If  active  steering  is  inhibited  (senable  = 0).  the  steering  switch  remains  at 
s steer  ~ case.  there  is  no  t computation  or  active  steering. 

An  engine  off  command  is  issued  when  t becomes  less  than  At 
.....  , g°  cut-off'  nd 

active  steering  is  terminated  at  that  time. 


4-2.4  Velocity-to-be-Gained  Routine 

The  Velocity-to-be-Gained  Routine  is  entered  every  major  guidance  cycle 
alter  completion  of  the  Cross-Product  Steering  Routine.  Since  the  calculation  of 
required  velocity  via  a solution  of  Lambert's  problem  in  the  Conic  Required  Ve- 
locity Determination  Routine  is  an  iterative  process,  it  may  not  be  completed  in 
one  major  guidance  cycle.  If  this  is  the  case,  when  it  is  recalled  by  the  Servicer 
Routine.it  is  entered  at  the  point  from  which  it  was  exited  in  the  previous  guidance 
cycle. 

Since  the  computations  in  this  routine  may  require  more  than  the  time  avail- 
able in  one  major  guidance  cycle,  it  is  necessary  to  distinguish  between  the  current 
state  vector  time  t,  which  is  updated  every  major  cycle,  and  the  time  associated 
with  the  solution  for  required  velocity.  Thus  the  time  reference,  t,  is  used  to 
define  the  time  associated  with  the  current  (in  process)  solution  for  required  velocity. 
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The  targeting  calculations  completed  prior  to  the  thrusting  maneuver  deter- 
mine an  offset  target  which  assumes  that  the  vehicle  is  under  the  influence  of 
spherical  gravity  after  ignition.  Therefore,  the  state  vector  input  to  the  Velocity- 
to-be-Gained  Routine  is  navigated  in  a spherical  gravity  field  after  Ug  , the  ignition 
time  assumed  by  the  targeting  program.  Throughout  this  section,  reference  to  the 
vehicle's  state  vector  will  imply  the  spherically  navigated  one  unless  specifically 
stated  otherwise. 

The  position  vector  used  as  the  initial  condition  for  the  Lambert  solution  is 
offset  from  the  actual  position  to  account  for  the  non-impulsive  nature  of  the  ma- 
neuver. A graphical  description  of  this  guidance  concept  is  shown  in  Figure  4. 

The  coasting  trajectory,  with  the  offset  initial  position,  is  shown  by  (T)  ; © is 

the  powered  trajectory  (spherical  gravity  field);  and  (3)  is  the  actual  trajectory 
(oblate  gravity  field).  The  offset  initial  position  is  selected  such  that  the  resulting 
coasting  trajectory,  defined  by  the  Lambert  required  velocity,  will  be  coincident 
with  the  powered  trajectory  at  thrust  termination.  The  velocity-to-be-gained  is 
defined  as  the  difference  between  the  (required)  velocity  on  the  coasting  trajectory 
and  the  velocity  on  the  powered  trajectory.  As  the  velocity-to-be-gained  is  driven 
to  zero,  the  powered  trajectory  approaches  the  coasting  trajectory.  The  powered 
trajectory  will  then  follow  a path  to  intercept  the  offset  target  while,  at  the  same 
time,  the  actual  trajectory  will  follow  a path  to  intercept  the  true  target. 

The  initial  position  difference,  Ar,  between  the  coasting  and  powered  tra- 
jectories can  be  computed  by  the  following  equation: 

l-g(T)| 

& 1 / _ \ 


where  v (t)  is  the  extrapolated  value  of  the  velocity-to-be-gained  vector  computed 
§ 

in  the  Cross-Product  Steering  Routine,  and  aT  (t)  is  the  current  estimate  of  the 
thrust  acceleration  magnitude.  The  offset  position  vector,  r'(r),  is  then  computed 
from 

r'  (t)  = r s (t)  + Ar  , 

where  rg  (r)  is  the  position  vector  on  the  powered  trajectory.  Using  this  offset  posi- 
tion vector,  a Lambert  solution  for  the  required  velocity  on  the  coasting  trajectory 
is  obtained  from  the  Conic  Required  Velocity  Determination  Routine. 
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) COASTING  TRAJECTORY  (SPHERICAL  GRAVITY  FIELD) 

POWERED  TRAJECTORY  (SPHERICAL  GRAVITY  FIELD) 

i)  ACTUAL  TRAJECTORY  (OBLATE  GRAVITY  FIELD) 

Figure  4.  Graphical  Description  of  Trajectories  used  in  Real 
Time  Required  Velocity  Updating  Guidance  Mode 
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If  the  Lambert  solution  for  required  velocity  cannot  be  completed  in  one  guid- 
ance cycle,  the  required  velocity  must  be  extrapolated  forward  before  computing 
the  velocity-to-be-gained.  Since  the  required  velocity  is  defined  on  a coasting  tra- 
jectory, only  the  spherical  gravitational  acceleration  need  be  considered,  First 
the  current  state  vector  time,  t,  must  be  obtained.  Then 

— ' req  (t)  = req  (t)  + 2 (t  ‘ 7 > t Ms  ( f ] + Is  ( t)  ] 

where  gg  (t)  and  gg  (t)  are  the  gravity  vectors  on  the  powered  trajectory  at  t and 
r , respectively.  Note  that  the  required  velocity  is  extrapolated  forward  by  numeri- 
cally integrating  the  average  gravitational  acceleration  on  the  powered  trajectory 
rather  than  on  the  coasting  trajectory.  This  approximation,  which  eliminates  the  need 
to  compute  the  gravitational  acceleration  on  the  powered  trajectory,  can  be  justified 
for  two  reasons:  first,  the  extrapolation  error  does  not  accumulate  over  the  entire 

maneuver  due  to  the  repetitive  nature  of  the  guidance  scheme;  second,  towards  the 
end  of  the  maneuver  when  accuracy  becomes  important,  the  gravitational  difference 
between  the  powered  and  coasting  trajectories  becomes  insignificant. 

After  the  required  velocity  has  been  extrapolated  to  the  time  associated  with 
the  current  velocity  vector,  the  velocity-to-be-gained  can  be  computed  from  the 
following  equation 


vg<t> 


v' 

— req 


(t) 


vg(t)  . 


The  Conic  Required  Velocity  Determination  Routine  has  a mode  in  which  a 
guess  of  the  independent  variable,  T , can  be  input  to  the  routine  in  order  to  reduce 
the  number  of  iterations  required  to  solve  Lambert's  problem.  The  iterated  value 
of  the  independent  variable  is  then  returned  on  the  output  list  so  that  it  can  be  used 
to  determine  a guess  for  the  next  Lambert  solution.  The  Velocity-to-be- Gained 
Routine  utilizes  this  mode.  It  uses  the  last  two  iterated  values  of  the  independent 
variable  to  compute  the  time  derivative  of  the  independent  variable.  This  derivative 
is  used  to  extrapolate  the  independent  variable  to  the  time  associated  with  the  next 
Lambert  solution.  This  extrapolated  value  is  then  input  to  the  Conic  Required  Ve- 
locity Determination  Routine  as  the  new  guess  of  the  independent  variable. 
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4.  2.  5 Deorbit  Targeting  Modification 

During  a deorbit  maneuver  degradation  in  engine  performance  is  compensated 
by  modifying  the  time  of  arrival  so  that  the  desired  terminal  flight  path  angle  is 
maintained.  Beginning  with  the  second  pass  through  the  Velocity-to-be-gained  Rou- 
tine the  desired  change  in  the  time  of  arrival  is  computed  in  the  following  manner. 

First,  a parameter  p^'  , which  is  a function  of  the  projected  terminal  (entry 
interface)  flight  path  angle,  is  computed  by  the  relation 

A 2 

p ' = sec  (y  . ) 


where 


f 2 - a if]  — 

L N J PN 


Projected  terminal  flight  path  angle 
with  respect  to  local  horizontal 
(negative  downward) 


r(t2)  = 


Target  position  vector 


- Current  vehicle  position  vector 
tion  vector 


ll  ( t2>l 

|r(t)| 


N : 


N 


Outputs  of  Conic  Required  Velocity 
Determination  Routine  (see  Ref.  3) 


The  desired  change  in  the  time  of  arrival  is  then  given  by 


6 t. 


[V  * Py](t2  - t} 


where 


' y 


Sensitivity  used  to  compute  <5t2 


P = Desired  value  of  sec  ( y ) 

t2 

p ^ is  an  input  variable,  k ^ is  a predetermined  constant  which  is  an  ap- 
proximation to  the  partial  derivative  of  the  change  in  the  time  of  arrival  with  respect 
to  the  change  in  sec  ( ~Y  f ) divided  by  the  time  of  flight  to  entry  interface.  Simu- 
lations have  shown  that  its2  value  is  nearly  constant  for  typical  deorbit  maneuvers. 
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Next,  the  inertial  target  vector  is  rotated  to  compensate  for  target  movement 
due  to  earth  rotation  and  change  in  the  time  of  arrival. 


cos  ( to 

earth 

6t2  ) 

sin  ( to 

earth 

6t2  ) 

0 

-sin  ( co  , , 

earth 

6t2) 

cos  (co  ,, 

earth 

(5t2  > 

0 

0 

0 

1 

r(t2  + 6t  2 ) = C r(t2) 

The  time  of  arrival  is  updated  by 

*2  = t2+  6t2 

The  updated  target  vector  and  time  of  arrival  are  used  in  the  Velocity-to-be-gained 
Routine  in  the  next  cycle. 

4.  3 Sequence  of  Events 

To  aid  the  reader  in  understanding  the  sequence  of  events  which  make  up 
a powered  maneuver,  a chronological  list  is  included  in  Figure  5. 
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h-  Prethrust 


I 


Maneuver  to  ignition  attitude 

Initialize  powered  flight  navigation 

Start  powered  flight  routines  (including  v^ 
routine  in  the  real-time  required  velocity 
mode) 

Initial  t prediction 
go 

Ignition 

Start  dual  state  vector  navigation  if 
in  the  Real  Time  Required  Velocity  Mode 

Short  burn  engine  cutoff  (t  <Atenable^ 
Enable  steering 


(—  Terminate  steering 

( t < At  . „ ) 

go  cut-off 


and  issue  cutoff  command 


Engine  cutoff 


Terminate  powered  flight  routines 


Figure  5.  Sequence  of  Events 
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5.  DETAILED  FLOW  DIAGRAMS 

This  section  contains  detailed  flow  diagrams  of  the  routines  used  for  powered 
flight  guidance. 

Each  input  and  output  variable  in  the  routine  and  subroutine  call  statements 
can  be  followed  by  a symbol  in  brackets.  This  symbol  identifies  the  notation  in 
the  corresponding  variable  in  the  detailed  description  and  flow  diagrams  of  the 
called  routine.  When  identical  notation  is  used,  the  bracketed  symbol  is  omitted. 
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UNIVERSAL 

CONSTANTS 


fOMS'  fACS 


PROGRAM 

CONSTANTS 


INPUT  VARIABLES 


t , r ( t ),  v ( t ), 

A^LV' 

t.  , m , s 
ig  eng 

s 

pert 

Select  thrust  f according  to  s 


d = 0 


Call  Precision  State  Extrapolation  Routine  (Ref.  2) 

Input:  r(t)[rQJ,  v(t)  [vQj  , t[tQ 

Output;  r(t.g)[rF]  , v(tlg)[vp] 

] ' lig  [l  f] ’ d’  Spert 

unit  j[r(t.g)x  v(t.g)]Xr(t.g)J 


i = unit  [ v ( t . ) X r ( t . )] 

-y  - ig  - ig 


iz  = - unit  [ £ (tig)  ] 


LV 


xz 


Av  i + Av  i 
X -X  z - z 


r(t.g)  X v(tig)  AvLV  m 


’ £<tig)  ] f 


= lA£xzl  unit  ( Avxz)  cos 


+ unit  ( a v X i ) sin 
- xz  -y 


-Gr) 


v (t.  ) 
-g  ig 


Av  + av  i 

-c  y -y 


unit  [ v (t.  ) 
-g  ig  ' 
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UNIVERSAL 

CONSTANTS 


PROGRAM 

CONSTANTS 


INPUT  VARIABLES 


fOMS’  fACS 


Att0  ' e0G 


t,  r ( t ), 

v(  t 

). 

r(t2). 

v V 

in , 

s 

soln' 

n , s 

s 

rev 

eng’ 

proj 

— N'  s pert 

Set  thrust  f according  to  s 


Call  Precision  State  Extrapolation  Routine  (Ref.  2) 

Input:  r ( t ) £rQJ  , v(t) 

• •[*»]  • *ig  [*p]  ■ 

spert 

Output:  r(t.g)  [rpJ  , v(t.g) 

M 

s = 0 , T =0 

guess  guess 


Call  Conic  Required  Velocity  Determination  Routine  (Ref.  3) 

Input: 

I(tig)  [l0]  ’ — ( t2  ^ [ll}  (t2  * 

t.g)  [At], 

n , s , , s , T 

rev  soln  guess  guess 

e0G  [econe]’ 

s • . i „ 
proj  -N 

Output: 

WV  |>]  'r  [ro] 
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Input: 

£' ‘V  [io 

’ t2)  [-l]  ’ (t2  ' tig)  [At  ]’ 

n , s , , 

rev  soln 

s , r 

guess  guess 

€0G  [e cone  ] 

’ s proj  ’ — N 

Output: 

v1  ( t . ) r 

- req  lg  L 

^o]  ■ r[r„] 

Figure  7b.  Prethrust  Phase  of  Real-Time  Required 
Velocity  Updating  Guidance  Mode 
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PROGRAM  UNIVERSAL  INPUT  VARIABLES  INPUT  VARIABLES 

CONSTANT  CONSTANTS  ( Delta-V  Mode  ) (Real-Time  Required 


Eigure  8a.  Powered  Flight  Routines 
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EXIT 

Figure  8b.  Powered  Flight  Routines 
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PROGRAM 


CONSTANTS 

INPUT  VARIABLES 

k 

steer 

^ cut-off  ’ 

r(t),  v ( t ) , Av  , v (t-At), 

Att2 

- ^ s steer 

, m.  At , t . , s 

ig  eng 

i 

V (t)  = 

V (t 

• At ) - Av 

-g 

-g 

Call  Initial  t Prediction  Routine 
(Fig.  10  )*  S° 


Input: 


v ( t ),  m,  s 
-g  eng 


'ig 


Output:  (1)  Long  burn:  s , , 

6 enable 

(2)  Short  burn:  s 

t 


go 

command 


enable’ 
engine-off 


No 


Set  ssteer  = 1 once  at 
f >tig+  Att2 


Yes 


NOTE:  This 
routine  is  called 
only  once  at 

time'  V^u- 


OUTPUT 

VARIABLES 


1 


Vl)’  Ssteer  = 0- 

a)  „ = 0,  no  t com- 
-c  go 


putation 


Figure  9a.  Cross-Product  Steering  Routine 
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Figure  yb.  Cross-Product  Steering  Routine 
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UNIVERSAL  PROGRAM 

CONSTANTS  CONSTANT  INPUT  VARIABLES 


Figure  io.  Initial  t Prediction  Routine 
g° 
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UNIVERSAL  PROGRAM 

CONSTANTS  CONSTANTS  INPUT  VARIABLES 


Figure  II a.  Velocity-to-be-Gained  Routine 
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Figure  lib.  Velocity-to-be-Gained  Routine 
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Figure  11c.  Velocity-to-be-Gained  Routine 
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6.  SUPPLEMENTARY  INFORMATION 

The  guidance  equations  presented  for  use  in  the  Real-Time  Required  Ve- 
locity Updating  Mode  represent  a departure  from  the  APOLLO  design.  A complete 
description  and  derivation  of  the  new  concept  can  be  found  in  Reference  5.  The 
principle  advantages  of  this  scheme  are  an  essentially  constant  attitude  maneuver 
and  an  improved  estimate  of  velocity-to-be-gained  for  more  accurate  cutoff.  In 
addition,  if  the  solution  for  required  velocity  cannot  be  completed  every  major  guid- 
ance cycle,  this  scheme  adapts  particularly  well  to  the  problems  of  intermediate 
velocity-to-be-gained  solutions  and  computational  lag. 

A comparison  between  the  STS  Lambert  guidance  equations,  as  formulated 
in  this  report,  and  the  APOLLO  Lambert  guidance  equations  has  been  made  for  two 
typical  STS  orbital  maneuvers  and  the  results  are  contained  in  Reference  4.  These 
results  show  that  the  STS  Lambert  guidance  equations  are  significantly  more  ac- 
curate than  the  APOLLO  equations.  For  the  two  maneuvers  that  were  analyzed,  the 
residual  velocities-to-be-gained  resulting  from  using  the  STS  equations  were  less  than 
0.  001  ft/sec. 
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9.7.4  Thrust  Vector  Control 

The  decision  has  not  yet  been  made  whether  the  OMPS 
engines  will  be  gimballed  or  fixed.  Additionally,  the 
possibility  is  being  explored  of  using  the  gimbal  actuators 
for  trim  but  not  for  active  TVC.  Consequently,  while  the 
nature  of  the  OMPS  engines  and  their  utilization  is  del- 
iberated, Equations  have  been  baselined  for  both  fixed- 
engines  and  gimballed-engines  TVC. 
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SPACE  SHUTTLE 

GN&C  SOFTWARE  EQUATION  SUBMITTAL 

Software  Equation  Section  Orbital  Powered  Flight  Submittal  No.  31 

Function  Orbital  TVC  Autopilot  (Fixed  OMPS) . 

Module  No.  QC3 Function  No.  1 (mod.).  2 (MSC  03690) 

Submitted  by:  J,  Sunkel  Co.  GCD  (EG-05152) 

Date:  8/24/71 

NASA  Contract:  W.  H.  Peters Organization  GCD 

(name) 

Approved  by  Panel  III  )4T.  Date  

(chairman) 

Summary  Description:  The  objective  of  the  autopilot  is  to  provide  attitude 

control  of  the  vehicle  during  on-orbit  powered  flight.  Control  implies 
following  pitch  commands  from  guidance. 

Shuttle  Configuration:  (Vehicle,  Aero  Data,  Sensor,  Et  Cetera) 

On  orbit  vehicle,  angular  rates  available,  control  toraqa  from  ACPS 

.jets, 

Comments:'  

(Design  Status)  . 

(Verification  Status)  Verification  simulations  performed.  . 

Panel  Comments:  
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9. 7. 4.1  A DIGITAL  FLIGHT  CONTROL  LOGIC  FOR  ON-ORBIT 

THRUST  VECTOR  CONTROL  WITH  OMPS  ENGINES  FIXED 


SUMMARY 

This  internal  note  documents  the  design  of  a DFCS  (digital  flight 
control  system)  for  on-orbit  TVC  (thrust  vector  control)  with  OMPS 
engines  fixed.  The  DFCS  logic  is  comprised  of  three  distinct  operating 
modes:  (l)  Large  error  convergence  logic,  (2)  limit  cycle  operation 
with  disturbance  torques  present,  and  (3)  minimum  impulse  limit  cycle 
operation.  Other  unique  features  are  (l)  Simple  disturbance  torque 
estimation,  (2)  limit  cycle  logic  that  produces  zero  time  average  state 
erors  while  avoiding  firings  that  are  in  phase  with  a disturbance  torque, 
and  (3)  extremely  simple  logic  for  determining  if  control  action  is 
required.  The  design  concepts  have  been  tested  and  verified  on  the 
Uni vac  1108  computer. 

INTRODUCTION 

This  analysis  is  concerned  with  the  development  of  a digital  auto- 
pilot able  to  control  orbiter  attitude  and  rate  during  on-orbit  thrusting 
maneuvers.  Basic  to  this  design  is  the  assumption  that  the  OMPS  engines 
are  fixed.  Thus  all  attitude  hold  and  steering  maneuvers  are  performed 
with  the  ACPS  (attitude  control  propulsion  system)  under  influence  of 
substantial  disturbance  torques. 

A summary  of  some  of  the  previous  work  done  in  this  area,  princi- 
pally by  MIT,  for  the  Apollo  Program  is  contained  in  reference  1.  This 
design  effort  has  endeavored  to  simplify  as  much  as  possible  the  compu- 
tations and  logic  required  in  these  earlier  DFCS  designs. 

The  design  effort  and  testing  has  been  limited  to  a single  axis 
which  has  been  assumed  to  be  the  orbiter  pitch  axis.  However,  the  same 
configuration  is  directly  applicable  to  the  roll  and  yaw  axes.  The  com- 
plete 3-axis  system  will  be  verified  in  the  six-degree-of -freedom  MSC 
SSV  functional  simulator  (reference  2). 

Problem  Definition 

For  rotation  in  the  pitch  plane,  the  moment  equation  is 

I 9 = T + M (l) 

where  T is  the  applied  control  torque  and  M is  a disturbance  torque. 

By  introducing  attitude  error  9 and  attitude  error  rate  9 as  our 
state  variables,  we  have 
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Therefore 

= 


T + M 
I I 


(2) 


We  assume 


T 

I 


< V 


where  V is  maximum  control  acceleration 


Define 

X 


Y1 

T 


= Y2 

~V 


sec 


sec 


Therefore 


X.  = *2 
V 

X = T 

2 IV 


x2 


+ M 
IV 


(3) 


Define 


T 

I V 


U 


nondimensional 


M 

LV 


n ond imen  s i ona 1 


Substituting  into  eqs  (3)  gives  the  normalized  state  equations 


X1  = X2 


X2  = U + D 


00 


where  |u|  ^ 1 
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The  problem  is  to  design  a digital  control  logic  for  the  system  in 
equation  (4),  which  will  reduce  large  errors  in  attitude  and  rate  to 
negligible  values  and  hold  them  there  in  the  presence  of  disturbance 
torques  while  performing  in  a fuel  optimal  manner.  The  autopilot  logic 
will  be  broken  into  three  parts:  (l)  Large  error  convergence  logic,  (2) 

limit  cycle  operation,  and  (3)  minimum  impulse  limit  cycle  operation. 


Large  Error  Convergence  Logic 


The  system  under  consideration  is  described  by  eqn.  (5),  where 
X i and  X2  are  the  state  variables  to  be  controlled  by  U and  D is  a 
disturbance  torque: 


X1  X2 


X2  = U + D 


(5) 


The  objective  will  be  to  define  a control  history  U (-fc)  over  the  time 
interval  t = 0 to  t = T,  where  T is  unspecified,  such  that: 


1.  The  system  is  driven  from  an  arbitrary  initial  state 


x1(o)  = S 1 
X2(0)  = S 2 

to  a fixed,  final  state 
X1  (T)  = 0 

X2  (T)  = 0 

2.  The  control  signal  is  limited  by  the  relation 
] U(-t)  U 1 for  t ^ [0,  T] 


(6). 


(7) 

(8) 


3.  The  control  signal  minimizes  a weighted  fuel-time  functional 
of  the  form 


I = 


(K  + | U | ) d t > K is  a positive  weighting  (9) 

constant 


The  objective  of  the  problem  is  to  find  the  functional  form  of 
the  control  U which  will  minimize  I in  eqn.  (9). 

The  solution  of  this  problem  is  documented  in  reference  3 for 
the  second  order  system: 
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X1  = X2 


x2  = U 


4 

(io) 


The  results  may  be  summarized  by  use  of  phase  plane  partitioning  and 
the  association  of  a control  signal  (U  = -1,  0,  l)  with  each  partitioned 

region.  Figure  1 shows  the  phase  plane  partitioned  into  four  regions 
G+,  G-,  H+,  and  H-.  The  partitioning  curves  +,  X P +,  and  T - 
are  associated  with  the  regions  as  follows: 


X + d G + 

X - C-  o - 

r+  c.  h + (ii) 


r-  c.  h - 

where  the  partitioning  curves  are  defined  as  follows : 


X- 

: X2> 

0, 

xi  = 

- lx 

2 

2 

(12a) 

X + 

: X2< 

o, 

xi  = 

1 X 

2 

2 

(12b) 

r- 

: X2^ 

o, 

xi  = 

iC 

K + 
K 

1) 

1 X 2 

(12c) 

r+ 

: X2> 

o, 

xi  = 

-i  ( 

K + 
. K 

4> 

|X  g 

(I2d) 

The  control  laws  derived 
switch  logic: 

may  be  summarized  as  a phase  plane 

U = -1 

for  (X1,  X2) 

£ 

G- 

o 

ii 

to 

for  (X1,  X2) 

£ 

H-  U H+ 

(13) 

U = +1 

for  (XL,  X2) 

e 

G+ 

Figure  1 also  shows  a typical  optimal  trajectory  originating  in 
G-.  Note  the  characteristic  "bang-coast-bang"  nature  of  the  control, 
due  to  the  weighted  fuel-time  cost  function. 
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Predicting  Control  Logic 


Derivation  of  a predictive,  or  open  loop,  control  history  U (t) 
is  a straightforward  application  of  the  previous  results  and  is  docu- 
mented in  reference  3 for  the  undisturbed  second  order  system  given 
by  equation  (10).  What  is  required  is  a determination  of  a switch 
time  (Ti)  for  each  trajectory  crossover  in  the  phase  plane,  as  a 
function  of  the  systems  initial  conditions  ( S q,  % 2)*  Figure  2 
shows  a trajectory  originating  in  G-  and  switching  at  t = T]_  and 
-fc  = T2>  The  switching  time  equations  are  summarized  as  follows: 


For  (I  i,f  2)  6 G" 


where 


» ^ K + 4 

K — K 


(14a) 


(14b) 


For 


d v%  2>  £ G+ 


(l4c) 


(l4d) 


If  ( 5 | 2^  ^ H - , it  is  clear  that  there  is  only  one 

switching  time  of  interest.  Let  T5  be  the  time  when  U switches  from 
U = 0 to  U = +1. 


Therefore 

T3  = 2 5 2-Si/s2  (15a) 

For  H + 


T 


3 


(15b) 


Once  U switches  from  U = 0 to  U = 1,  the  system  follows  the  ^ 4-curve 
to  the  origin.  Let  T4  be  the  time  predicted  to  travel  to  the  origin. 
Then  if  the  system  switches  at  (Bi,  -B2),  T4  is  given  by: 


T4  = - B2 
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Similarly  for  the  X - curve 


T>.  = Br 


(16b) 


The  equations  above  have  been  derived  for  the  system  given  by  equation 
(10).  The  question  which  now  arises  is  what  effect  a disturbance 
torque  has  on  the  above  results.  If  we  assumed  that  the  "bang-coast- 
bang"  nature  of  the  solution  will  remain  the  same,  and  still  require 
that  the  final  state  condition  be  the  origin  of  the  phase  plane,  as 
specified  by  equation  (7),  then  the  X + and  Y - curves  must  be 
replaced  by  the  natural  trajectories  of  the  system  (5)  which  intersect 
the  origin.  Thus  the  disturbance  torque  is  factored  into  equations 
(12a)  and  (12b)  which  become: 


- 


x2> 


0 


2(-l  + D)  X 2 


(17a) 


X2^ 


X, 


X 


2(  1 + D)  2 


(17b) 


The  time  to  travel  to  the  origin  (T^)  along  theX+  becomes: 

_ _ ^2 

TU  1 + D 


(18a) 


Similarly  for  the  X - 


curve 

B2 

D - ] 


(18b) 


In  the  case  of  the  P curves,  however,  the  equations  become 
extremely  complicated  when  a disturbance  torque  is  considered.  The  same 
is  true  of  the  expressions  for  T^,  Tg,  and  T^.  The  very  small  errors 

which  result  from  ignoring  the  disturbance  torque  dictate  that  these 
equations  remain  unchanged. 

The  equations  summarized  above  constitute  the  predictive  controller 
to  be  used  in  the  large  error  convergence  logic. 

Limit  Cycle  Operation 

Once  the  large  error  convergence  logic  has  reduced  large  errors 
in  attitude  and  rate  to  relatively  small  values,  we  need  an  attitude  hold 
logic  which  will  allow  us  to  operate  within  a small  region  about  the 
phase  plane  origin  with  minimum  fuel  usage.  This  dictates  the  need  for 
a "fuel  efficient"  limit  cycle  logic.  In  addition  to  the  fuel  economy 
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requirement  there  is  a requirement  that  the  time  average  attitude 
deviation  from  the  phase  plane  origin  (attitude  error)  he  near  zero  to 
avoid  inserting  a bias  in  the  guidance  loop. 

Basically,  the  "limit  cycle"  requirements  are  met  by  the  following 
design  features  which  are  illustrated  in  figure  3: 

a.  No  control  action  is  taken  as  long  as  the  two  element  state 
vector  magnitude  is  less  than  a specified  constant  El. 

b.  Limit  cycle  conditions  are  differentiated  from  large  error 
convergence  conditions  by  another  check  on  the  state  vector  magnitude 
for  exceeding  a specified  value  R2. 

c.  When  significant  disturbance  torques  exist,  control  torque 
application  times  are  computed  based  on  the  time  required  for  the 
intersection  of  two  parabolas.  The  first  is  the  trajectory  parabola 
defined  by:  (l)  Current  state,  (2)  control  acceleration,  and  (3)  dis- 
turbance acceleration.  The  second  parabola  is  the  unique  symmetrical 
limit  cycle  parabola  defined  by  the  two  requirements:  (l)  Time  integral 
of  attitude  error  is  zero,  and  (2)  control  torque  applied  upon  state 
vector  magnitude  exceeding  Rl,  with  the  simplifying  assumption  that 
the  time  of  control  torque  application  is  small  compared  to  the  remain- 
der of  the  limit  cycle  period. 

d.  When  both  disturbance  torque  and  rate  error  are  less  than 
specified  quantities, then  a minimum  impulse  is  fired. 

These  features  are  derived  and  discussed  in  following  sections  of 
this  report. 


Derivation  of  Distur.bance  Torque  Limit  Cycle  Logic 

Derivation  of  a predictive  control  history  requires  that  we  deter- 
mine the  proper  sense  of  U and  control  application  time  TJET 
for  each  trajectory  crossover  of  the  Rl  circle,  as  a function  of  the 
crossover  point. 

The  sense  of  the  control  U is  determined  by  the  quadrant  in  the 
phase  plane  in  which  the  trajectory  crosses  the  switch  curve. 


The  proper  jet  on  time  depends,  however,  on  whether  or  not  dis- 
turbance torques  are  present.  As  a trajectory  crosses  the  Rl  circle 
switch  curve,  the  autopilot  makes  a disturbance  torque  estimate  by 
simply  dividing  the  change  in  the  state  X2  by  the  time  lapse.  That  is 


D = 


2F 


£ 
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where  T = control  sample  period 


N = number  of  control  logic  passes  since  terminating  the  last  firing. 


Figure  4 shows  a typical  limit  cycle  trajectory  with  a positive 
disturbance  torque  present.  The  trajectory  crosses  the  switch  curve 
at  (S-pfp).  At  this  point,  the  autopilot  estimates  the  disturbance 
torque  and  in  this  case,  finds  it  to  have  a positive  sense.  Next,  the 
autopilot  determines  the  sense  of  the  control  U. 

A positive  attitude  error  and  positive  rate  error  requie  that  a 
negative  control  be  applied,  thus  U = -1. 

The  problem  now,  with  the  disturbance  torque  and  control  sense  known, 
is  to  find  the  jet  on  time. 

The  jet  on  time  will  be  calculated  so  that  the  resulting  limit  cycle 
trajectory  is  expected  to  satisfy  the  following  condition: 


T 

\ xx  dt  = 0 (19) 

where  T is  the  time  lapse  from  application  of  control  torque  to  the 
anticipated  time  for  application  of  the  next  control  torque  pulse. 

Satisfying  equation  (19)  results  in  a symmetrical  limit  cycle  about 
the  phase  plane  origin  with  zero  average  attitude  error. 

Figure  5 illustrates  the  desired  symmetrical  limit  cycle.  The  prob- 
lem is  to  calculate  X?  from  which  the  required  jet  on  time  is  readily 
available.  To  do  this,  we  assume  g 2?  X . With  S , §2,  the  disturbance 
torque,  and  X^  known,  X^  can  be  derivedas  shown  below.  From  equation 
(19),  we  have: 

P 

\ X1  dt  = 0 

y o 


The  equation  of 

X2 

X2 

X1  = 2~D 


the  symmetrical  parabola  is  given  by: 

- A 


(20) 


where:  D is  the  disturbance  torque 

A is  unknown 
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Substituting  (20)  into  (19)  results  in 
T 

( 2%  - A>  at  = o 

o 

We  neglect  the  jet  on  portion  of  the  limit  cycle  since 
xxdt^  ^ qN<<  *■  \ Xidt^  jet  OFF 


Substituting  from  equation  (5)  into  equation  (21)  gives 


(21) 


Integrating j 


2 


6 D 


A 

D 


X2F 


0 


(22) 


2 2 2 

Substituting  equation  (2)  into  the  constraint  X,„  + X0„  = R1 

-Lb  C.2 


results  in 


(- 


2F 


2 D 
But  A = 

,4 


A)2  + X22f  = Rl2 


(23) 


X 


2F 


X 


6 D 
2 


from  (22).  Substituting  into  equation  (23)  results  in: 


2f  4 X2F  - R 1 2 = 0 


9 D 2 


(24) 
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Solving  the  quartic  gives: 


The  ambiguity  of  the  + sign  is  resolved  by  the  fact  that  in  the 
case  where  the  disturbance  torque  is  positive  X ^ must  be  negative, 
implying  that  the  negative  sign  is  used.  Thus 


Crossing  over  the  switch  curve  in  quadrant  III  with  a negative  dis- 
turbance torque  results  in  the  same  equation.  Crossing  the  switch  curve 
in  quadrant  III  with  a positive  disturbance,  however,  requires  a change 
in  logic.  In  this  case  all  that  is  required  is  sufficient  control  to 
achieve  a small  positive  rate.  The  disturbance  torque  alone  will  then 
drive  the  system  into  quadrant  I.  This  logic  lets  the  disturbance 
torque  do  the  work  and  saves  on  fuel.  In  this  case,  we  arbitrarily  set 

X2p  = 4%  2 (27) 


Crossing  the  switch  curve  in  quadrant  I with  a negative  disturbance 
torque  requires  the  same  logic. 


Once  XgF  has  been  determined,  the  predicted  jet  on  time  TJET  is 
calculated  from  the  required  rate  change  divided  by  the  anticipated 
acceleration: 


TJET 


X2F  ^ 2 
U + D 


(28) 


Minimum  Impulse  Limit  Cycle  Logic 

Figure  6 shows  a typical  minimum  impulse  limit  cycle  trajectory. 

The  trajectory  crosses  the  switch  curve  at  ( -5^  , % 2 )•  At  this  point, 

the  autopilot  estimates  the  disturbance  torque  and  in  this  case,  finds 
it  to  be  zero  or  less  than  a small  predetermined  value.  In  addition, 
the  trajectory  must  crossover  the  switch  curve  within  the  minimum  impulse 
threshold.  With  these  two  conditions  satisfied,  the  autopilot  determines 
the  sense  of  the  control  U.  In  this  case,  we  have  a negative  attitude 
error  and  negative  rate  error  which  requires  that  a positive  control  be 
applied,  thus  U = +1. 

The  jet  on  time  in  the  minimum  impulse  limit  cycle  mode  is  a fixed 
impulse  of  50  milliseconds.  Therefore, 

TJET  = .05  sec  (29) 


9,7-121 


9. 7. 4.1  TVC . Fixed  (cont'd) 


Summary- 

Discussion  of  Control  Logic 


11 


Figure  7 illustrates  the  complete  OMPS  TVC  digital  flight  control 
system  logic  in  the  phase  plane.  In  summary,  the  area  enclosed  by  the 
circle  of  radius  R1  is  the  coast  region  and  no  jets  are  fired  while  the 
state  is  within  this  region  except  during  convergence  from  large  error. 
The  perimeter  of  the  R1  circle  is  the  switch  curve  for  limit  cycle 
operation.  Once  the  state  crosses  the  R1  switch  curve,  the  limit  cycle 
logic  determines  the  proper  sense  of  the  control  U and  the  jet  on  time 
TJET  required  to  limit  cycle  about  the  phase  plane  origin.  The  perimeter 
of  the  R2  circule  is  the  limit  cycle  large  error  convergence  interface. 
Any  rate  or  attitude  change  which  causes  the  state  to  exceed  the  R2 
perimeter  switches  the  autopilot  into  large  error  convergence  logic. 

Note  that  when  the  autopilot  is  in  the  limit  cycle  mode,  the  large 
error  convergence  logic  switch  curves  are  not  used. 

The  simplicity  of  the  design  is  readily  apparent.  Given  a point 
(5-^j  S 2)  the  radius  vector  is  calculated  as  follows: 

R = 4 S I"  + 5 2 

Proper  control  action  is  determined  by  comparing  R with  R1  and  R2. 
Further  computational  economy  is  obtained  by  use  of  flags  (logic 
switches),  which  effectively  provide  a memory  of  the  operating  mode.  A 
flowchart  of  the  logic  is  shown  in  figure  8. 

Simulation  Results 


The  autopilot  logic  has  been  programmed  in  Fortran  IV  and  a number  of 
runs  have  been  made  on  the  Univac  1108  to  verify  the  design  concepts. 
Table  I lists  the  values  of  constants  used  in  the  simulation.  The 
results  of  several  simulation  runs  appear  as  figures  9 through  13,  and 
are  discussed  below. 


Figure  9 illustrates  the  large  error  convergence  logic.  The  initial 
conditions  for  the  run  were  (2,  0).  The  inclination  of  the  trajectory 
in  the  coast  region  is  due  to  the  presence  of  a disturbance  torque.  In 
this  case,  a constant  disturbance  torque  of  +.1  was  present.  Note  that 
the  trajectory  slightly  overshoots  the  % + switching  curve.  This  is  due 
to  the  autopilot  sampling  period.  The  control  switched  from  U = +1  to 
U = 0 at  ( -.007,  .06). 

Figure  10  illustrates  the  disturbance  torque  limit  cycle  logic  and 
therefore  only  the  limit  cycle  switch  curves  are  shown.  This  run  is 
a continuation  of  run  1 after  control  switch  off.-  The  disturbance 
torque  was  again  constant  at  +.1.  The  main  feature  to  be  noted  in 
figure  12  is  the  operation  of  the  symmetrical  limit  cycle  logic.  Note 
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that  we  have  converged,  to  a symmetrical  limit  cycle  after  one  cycle. 

The  limit  cycle  trajectories  overshoot  the  R1  switching  curve  due  to 
sampling  period  of  the  autopilot. 

Figure  11  illustrates  the  disturbance  torque  limit  cycle  logic  'for 
a.  constant  disturbance  torque  of  -.01.  Here  again,  we  enter  a symmetri- 
cal limit  cycle  during  the  first  cycle. 

Figure  12  illustrates  the  minimum  impulse  limit  cycle  logic  for  a. 
constant  disturbance  torque  of  +.001.  In  this  mode,  the  limit  cycle 
switches  twice  during  each  cycle.  Note  that  during  the  second  cycle, 
the  trajectory  exceeds  the  minimum  impulse  threshold  as  it  crosses  the 
switch  curve.  This. is  due  to  the  effect  of  the  positive  disturbance 
torque.  In  this  case,  the  system  switches  into  the  disturbance  torque 
limit  cycle  logic  and  calculates  a jet  on  time  required  to  enter  a sym- 
metrical limit  cycle  with  a disturbance  torque  of  +.001.  The  system 
will  switch  back  to  total  minimum  impulse  limit  cycle  operation  in  one 
or  two  cycles  and  then  the  sequence  will  repeat.  Had  the  system  not 
switched  into  the  disturbance  torque  limit  cycle  logic,  the  minimum 
impulse  limit  cycles  would  have  gradually  shifted  upward  along  X2  and 
eventually  triggered  the  large  error  convergence  logic. 

Figure  13  illustrates  the  operation  of  the  disturbance  torque 
limit  cycle  logic  when  a change  occurs  in  the  disturbance  torque.  In 
this  case,  the  disturbance  torque  changes  from  +.1  to  -.01  at  the  end 
of  a firing  sequence.  Notice  that  the  limit  cycle  trajectory  immediately 
begins  to  diverge  and  crosses  the  HI  switching  circle  in  quadrant  III. 

The  symmetrical  limit  cycle  logic  now  targets  for  a point  on  the 
D = -.01  symmetrical  limit  cycle.  The  trajectory  overshoots  the  target 

point  which  results  in  an  additional  jet  firing  but  then  the  system  does 
enter  the  D = -.01  symmetrical  limit  cycle. 

Concluding  Remarks 

This  study  has  established  and  verified  design  concepts  for  an 
on-orbit  TVC  DFCS  with  0MPS  engines  fixed.  Additional  simulation  will 
be  required  to  establish  (l)  the  suitability  of  the  design  for  coupled 
3-axis  operation,  (2)  numerical  values  for  the  various  constants  and 
deadbands  based  on  the  actual  performance  of  the  orbiter  (i.e.,  nonnor- 
malized  system)  and  (3)  projected  ACPS  propellant  utilization  for  this 
type  of  attitude  control  for  specific  SSV  orbiter  configurations  to 
generate  trade  information  regarding  weight  effectiveness  of  this  con- 
trol scheme  versus  hydraulically  gimballed  engines. 

The  fixed  engine  TVC  logic  presented  herein  has  the  unique 
features  of  (l)  simple  logic  for  disturbance  torque  estimation,  (2) 
extremely  simple  logic  if  control  action  is  not  required, (3)  limit  cycle 
logic  that  provides  "integral  error  compensation"  for  external  disturbances 
and  (4)  simple  logic  for  selecting  one  of  three  possible  control  modes. 
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9. 7. 4.1  T7C . Fixed  (cont'd) 


TABLE  I.-  SIMULATION  CONSTANTS 


K = 1 

R1  = .25 

R2  = .3 

DMIN.  = .0033 

THRESHOLD  = . 045 
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9. 7. 4.1  TVC,  Fixed  (cont'd) 


Figure  2.-  Phase  plane  switch  times. 
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9. 7. 4.1  TVC.  Fixed  (cont*d) 


Figure  3.-  Limit  cycle  design, 
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9. 7. 4.1  TVC.  Fixed  (oont'd) 


Figure  6«-  Minimum  impulse  limit  cycle. 
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Figure  7.-  TVC  DFCS. 


Figure  8a.- 


ENTER 


Figure  8b.-  Functional  flow  chart. 
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9. 7. 4.1  TVC.  Fixed  (cont'd) 
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Figure  10.-  Disturbance  torque  limit  cycle  - D=+.1 
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9. 7. 4*2  TVC . Gimballed! '( Continued ) 


1.  INTRODUCTION 

The  subject  of  this  report  is  a preliminary  design  for  control  of 
the  Shuttle  Orbital  Maneuvering  Propulsion  System  (OMPS)  gimballed  engines 
during  orbital  burns.  For  the  preliminary  design,  it  was  assumed  that 
the  gimballed  engines  will  provide  all  the  required  control.  Other  types 
of  thrust  control  will  be  considered  in  later  designs;  these  will  include 
reaction-jet  control  and  a combination  of  reaction- jet  and  gimballed- 
engine  thrust  vectoring. 

Reference  1 supplied  the  data  on  vehicle  configuration  and  OMPS 
actuator  performance  boundaries  used  in  this  study.  One  of  the  objectives 
of  the  preliminary  design  is  to  evaluate  the  configuration  and  determine 
if  any  serious  control  problems  result  from  the  vehicle  design.  The 
subject  configuration  (NR  161-C)  creates  several  such  problems  which  will 
be  discussed  below. 

One  of  the  groundrules  assumed  for  this  study  is  that  the  Thrust  Vector 
Control  (TVC)  system  be  compatible  with  External  Delta-V  guidance  as 
defined  for  Apollo.  This  type  of  guidance  computes  the  velocity  incre- 
ment required  based  on  the  orbital  parameters  desired  at  the  completion 
of  the  burn  and  the  current  parameters  determined  by  navigation.  The 
velocity  gain  (Vg)  desired  is  computed  once  only  for  the  entire  burn 
and  entered  into  the  computer  as  an  external  command  prior  to  the  sched- 
uled ignition  time.  The  vehicle  attitude  is  aligned  by  the  reaction  jets 
to  the  direction  determined  by  the  computer  from  the  direction  of  the  V 
vector  and  the  estimate  of  trim  thrust  direction  relative  to  the  vehicle. 
During  the  burn,  the  Vg  vector  is  updated  periodically  by  sensed  accelera- 
tion for  the  purpose  of  determining  engine  cut-off  time  and  for  command- 
ing the  TVC  to  remove  cross-axis  (lateral)  velocity  errors  that  have 
accumulated.  Elaborate  preburn  alignment  and  frequent  velocity  updates 
yield  greater  burn  accuracy  (or  lower  TVC  requirements)  when  coupled  with 
External  Delta-V  guidance  because  the  target  velocity  is  not  changed 
during  the  burn.  The  TVC  is  designed  for  sensitivity  to  velocity  errors 
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9. 7. 4. 2 TVC.  Gimballed  (continued) 


and  cannot  cope  with  large  transients  or  abrupt  sign  reversals  in  the  Vg 
commands  which  result  from  other  types  of  guidance. 

The  basic  task  of  the  TVC  system  is  to  null  the  accumulated  cross- 
axis velocity  errors  during  the  burn.  An  opposing  cross-axis  accelera- 
tion is  required  to  null  the  velocity  errors.  The  thrust  vector  is  con- 
trolled by  rotating  the  vehicle  until  the  required  acceleration  is  obtained. 
The  vehicle  steering  in  this  Shuttle  design  differs  from  the  Apollo  SPS  TVC 
in  two  significant  respects;  steering  commands  are  proportional  to  the 
cross-axis  velocity  and  no  direct  attitude  control  is  employed.  These 
changes  from  Apollo  will  improve  the  end-of-burn  steering  loop  stability 
and  reduce  residual  velocity  errors  due  to  pointing  errors. 

Attitude  stabilization  and  steering  rates  are  achieved  by  a rate 
control  loop  which  issues  deflection  commands  to  the  actuator  position 
control.  Included  in  the  actuator  commands  are  estimates  of  trim  deflec- 
tions which  are  continually  updated  during  the  burn  so  that  rate  biases 
are  eliminated. 

In  the  remaining  sections  of  this  report,  the  results  associated 
with  the  preliminary  design  will  be  reported.  The  first  topic  will  be 
the  basic  concept  of  the  control  system  and  the  reasons  for  selecting  it. 
The  second  section  will  present  the  vehicle  mass  properties  and  actuator 
performance  data  used  as  inputs  to  the  study.  The  modeling  of  the  actuator 
dynamics  will  then  be  treated  in  detail  because  of  the  effects  of  actuator 
nonlinearities  on  the  total  design  effort.  The  software  design  will  be 
described  in  two  sections;  the  first  of  these  sections  will  be  devoted 
to  the  rate  loop,  and  the  second  to  the  accelerometer  loop.  The  last 
section  reporting  results  will  estimate  the  sensor  requirements  that  would 
be  consistent  with  the  system  developed.  The  final  sections  of  this  report 
will  consist  of  the  software  equations  for  the  preliminary  TVC  design  and 
a review  of  the  study  progress  to  date. 
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9. 7. 4-2  TVC.  Gimballed  (continued) 


LIST  OF  SYMBOLS 


Subscripts: 

c commanded  (desired) 
m measured 
2 cross  axis  (pitch) 

(*)  derivative  with  respect  to  time 
(_)  vector 


A 

ACPS 
DAP 
E,  Ep 

EA 

I 

K 


K' 

K, 


e 

H 
« A 

Lvor 


in 

o*rs 

s 


Acceleration  (see  Subscripts) 

Attitude  Control  Propulsion  System 
Apollo  control  system 
ACPS  control  error 
Acceleration  control  error 
Moment  of  inertia  of  vehicle 
Actuator  forward  loop  gain 
Trim  bias  integrator  gain 
Acceleration  loop  gain 
Steady-state  gain  of  rate  filter 
Velocity  error  gain 
Actuator  rate  feedback  gain 
Frequency-dependent  gain  of  rate  filter 
Thrust  control  moment  arm 
Acclerometer  moment  arm 

Linear  Variable  Differential  Transducer;  converts  actuator 
displacement  to  deflection  angle 

Vehicle  mass 

Orbital  Maneuvering  Propulsion  System 
Laplace  operator 
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9. 7. 4. 2 TVC.  Gimballed  (continued) 


LIST  OF  SYMBOLS  (continued) 

SPS  Apollo  Service  Module  Propulsion  System 

t Elapsed  time 

T Thrust 

TACH  Tachometer;  measures  actuator  displacement  rate 

Vg»  VG  Velocity-to-be-gained  (see  Subscripts') 

(Vg)zero  Preburn  Delta-V  command 
AV  Velocity  gained  during  burn  (see  Subscripts) 

a Thrust  vector  angle 

y Velocity  error  vector  angle 

6 Engine  delfection  angle  (see  Subscripts) 

6cg  Actual  cg-trim  engine  deflection  angle. 

<$Est  . , Preburn  trim  estimate. 

6p£  Peak  engine  deflection  angle 

6TRIM  Updated  trim  estimate 

A A Control  deflection  command  . 

Acceleration  error 
eg  Vehicle  rate  error 

e,Ae  Vehicle  pointing  angle  (see  Subscripts), 

5 Thrust  vector  angular  error 

t Time  constant  of  rate  filter 

<(>  Phase  shift  or  phase  angle 

w Frequency  of  sinusoidal  input 
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9. 7. 4.2  TVC.  Gimballed  (continued) 


2.  BASIC  CONCEPT 

The  basic  concept  for  the  preliminary  TVC  design  is  shown  in  the 
simplified  pitch  plane  block  diagram  of  Figure  1.  The  software  is 
divided  into  two  sections,  steering  and  rate  stabilization.  The  actuator 
electronics  is  depicted  as  an  analog  computer  and  torque  generator.  The 
actuator  dynamics  complete  the  feedback  loops  to  the  two  actuator  sensors, 
and  the  vehicle  dynamics  model  closes  the  rate  gyro  and  accelerometer 
loops  to  the  software  interface.  Three  other  inputs  to  the  software  are 
shown  in  the  block  diagram;  they  are  the  preburn  guidance  commands  and 
trim  estimates  and  the  manual  steering  commands.  Gains  and  filter  coef- 
fi cents  can  be  treated  as  preburn  input  constants. 

The  guidance  commands  in  the  cross-axis  direction  are  always  zero 
for  External  Delta-V.  Vz  is  the  cross-axis  velocity  error  as  shown 
in  Figure  2.  Cross-axis  velocity  results  from  errors  in  pointing  the 
thrust  vector  along  the  initial  Vg  vector.  As  the  cross-axis  velocity 
accumulates,  the  Vg  vector  rotates  thru  an  angle  y in  Figure  2.  In  order 
to  reduce  the  cross-axis  velocity  (Vz),  the  thrust  vector  must  be  rotated 
to  an  angle  above  the  initial  Vg  vector  so  that  an  acceleration  component, 
A^,  is  obtained  in  the  same  direction  as  Vz.  However,  the  time  remaining 
for  taking  out  Vz  is  approximately  Vg/A  (time-to-go) . The  time  required 
to  null  Vz  is  potentially  Vz/Az;  in  terms  of  the  angles  y and  a,  the 
thrust  vector  angular  error  is  very  nearly  (y-a).  Apollo  steering  is 
based  on  the  error  angle  (y-a)  as  a result  of  the  steering  law: 

= Ks  (]_£  x lyG) 

This  cross  product  of  unit  vectors  along  the  A and  V vectors  yields  a 
pitch  component  of  steering  commands  as  follows: 

= KS  Sin  (y-01) 
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FIGURE  1 
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STEERING  CONCEPT 
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9. 7. 4*2  TVC . Gimballed  (continued) 


The  parameter  we  would  like  to  null  is  the  cross-axis  velocity,  and  the 
steering  response  to  Vz  can  be  obtained  by  substitution  for  y and  a 
using  Figure  2;  that  is: 

®C  = KS  <YVg  - VA> 

(A/Kg)  0£  = (A/Vg)  Vz  - Az  where  A = Thrust/mass 

From  the  last  equation  we  determine  that  the  Apollo  steering  gain  is 
inversly  proportional  to  the  time-to-go  before  engine  shut-down. 

The  variable  gain  resulting  from  the  Apollo  steering  design  creates 
several  problems  which  can  be  avoided  with  the  "constant-gain"  steering 
in  Figure  1.  From  Figure  1,  the  equation 

0/Ka)  0c  = (K$)  Vz  - Az 

is  comparable  to  the  Apollo  equation  derived  above,  which  can  be  written 

(1/K-) (T/m)  0 = (T/m) (1/V  ) V7  - A 

~ y 9 z z 

By  adjusting  the  gains  in  the  proposed  shuttle  steering  equation,  the  two 

equations  could  be  identical  except  for  the  variations  in  V . At  the 
start  of  a long  burn,  the  Apollo  steering  is  very  slow  because  of  the  low 

gain;  most  of  the  steering  rate  is  due  to  vehicle  pointing  errors  and 

engine  gimbal  transients.  Four  seconds  before  engine  cut-off,  the  steer- 
ing gain  is  too  high,  and  better  end  conditions  are  achieved  by  commanding 
zero  rates.  The  Apollo  steering  gain  at  6 seconds  from  cut-off  is 
1/(6  seconds)  or  0.167/seconds. 

The  basic  idea  behind  the  shuttle  TVC  concept  is  to  provide  the 
highest  steering  gain  consistent  with  stability  throughout  the  burn,  in- 
cluding the  last  4 seconds.  The  shuttle  steering  will  be  dominated  by 
attitude  and  gimbal  transients  during  the  first  few  seconds  of  the  burn; 
this  early  response  is  the  same  as  in  Apollo  burns  and  results  from  the 
accelerometer  feedback,  Az.  During  the  mid-burn  period  the  shuttle  steer- 
ing will  produce  an  exponential  decay  in  Vz  and  the  control  response  will 
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9. 7. 4. 2 TVC,  Gimballed  (continued) 


decay  proportionally.  At  the  end  of  the  burn,  the  velocity  residuals 
should  be  small,  and  the  control  system  should  respond  slightly  to  these 
errors. 

Referring  again  to  Figure  1,  the  shuttle  concept  has  no  redundant 
attitude  control  loop.  The  Apollo  DAP  contains  an  attitude-hold  feature 
which  opposes  the  change  in  attitude  required  for  steering.  The  steering 
error  (Eft  in  Figure  1)  is  proportional  to  the  thrust  vector  pointing  error, 
which  is  the  only  "attitude  error"  needed  to  command  the  correct  vehicle 
rates.  The  pointing  of  the  vehicle  is  otherwise  irrelevant  to  thrust 
vector  control. 

The  gain  in  Figure  1 controls  the  attitude  response  of  the  vehicle; 
the  vehicle  pointing  error  is  the  angular  equivalent  of  the  acceleration 
error  (E^)  defined  by  the  steering  equation.  The  attitude  error  (E0)  can 
be  computed  from  the  equation: 

E0  = EA/(T/m) 

The  equivalent  "attitude  loop  gain"  is: 

VE0  = (T/m>KA 

The  "control  law"  can  be  obtained  by  incorporating  the  rate  loop  gain 
as  follows: 


A6C  = (T/m)(KA)(K-)  E0  + (K-)  0 

Too  much  emphasis  should  not  be  placed  on  the  "control  law"  as  a repre- 
sentation of  any  control  system.  Aerospace  vehicle  control  systems  require 
D.C.  bias  compensation,  signal  shaping  for  stability,  and  filtering  for 
noise;  that  is,  K0  in  the  above  equation  is  a frequency-dependent  gain  or 
"filter". 

The  output  of  the  software  is  a vehicle  angular  acceleration  command 
converted  to  a total  engine  deflection  angle.  Because  the  angular  accel- 
eration is  not  necessarily  zero  for  a null  deflection  angle,  a trim 
deflection  bias,  is  added  to  the  control  deflection.  Before  the 

burn,  the  trim  bias  is  estimated;  then,  the  estimate  is  updated  during 
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the  burn  by  integrating  the  acceleration  commands  and  adding  small  incre- 
ments to  the  trim  bias.' 

In  the  roll  axis,  this  study  assumes  no  requirement,  for  steering  or 
attitude  control.  A simple  roll  rate  damping  control  is  provided  using 
the  pitch  actuators.  Low  roll  rates  will  prevent  any  coupling  between 
pitch  and  yaw  steering,  and  the  small  roll  angle  which  may  develop  should 
not  violate  any  antenna  or  window  pointing  constraints.  The  outputs  of 
the  software  are  pitch/roll  and  yaw  deflection  commands  to  the  actuator 
electronics  of  the  two  OMPS  engines. 

In  review  of  the  preliminary  Shuttle  TVC  design  concept,  the  follow- 
ing features  are  listed: 

1)  Constant-gain  steering  is  used  to  eliminate  cross-axis 
velocity  errors  early  in  the  burn. 

2)  Attitude  control  is  based  on  thrust  vector  errors 
only. 

3)  A trim  integrator  is  provided  to  eliminate  command 
biases. 

4)  Simple  rate  damping  is  employed  in  the  roll  axis 
control . 

In  the  following  paragraphs,  the  development  of  this  concept  into  a 
preliminary  design  will  be  discussed. 
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3.  CONFIGURATION  DATA 

The  mass  properties  and  OMPS  engine  data  required  for  completing  the 
preliminary  TVC  design  were  selected  from  that  given  in  Reference  1.  This 
data  is  presented  in  Table  I for  orbital  maneuvers.  Table  II  gives  the 
same  data  after  it  has  been  manipulated  into  the  required  form.  A block 
diagram  of  the  vehicle  dynamics  appears  in  Figure  3. 

Because  of  the  small  variance  in  vehicle  dynamics,  it  was  not  nec- 
essary to  vary  gains  or  filter  coefficients.  The  nominal  dynamics  gains 
in  Table  II  were  used  to  derive  the  following  transfer  functions  required 
for  the  sensor  feedbacks: 

0/6  = -0.06/s  per  sec 

. -0.1207  (s2  - 0.314)  ft/sec2 

zm/0  s deg/ sec 

The  actuator  limits  given  by  Reference  1 are  as  follows: 

6 limit  = +4° 

« 

6 limit  = +7  deg/sec 

••  2 

6 limit  = +35  deg/sec 

The  impact  of  these  actuator  limits  on  the  control  design  will  be  dis- 
cussed in  the  following  section. 

The  bending  frequency  range  is  1.25  to  1.5  Hz  according  to 
Reference  1.  No  amplitude  data  was  provided,  so  it  was  assumed  that 
the  bending  frequencies  would  require  an  attenuation  of  30  db.  Slosh 
was  not  treated  in  the  preliminary  design;  however,  Apollo  experience 
has  shown  slosh  can  be  a difficult  problem.  The  topic  of  slosh  stabi- 
lization will  be  a major  consideration  during  the  final  design  phase 
of  this  study. 
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TABLE  II  - VEHICLE  DYNAMICS  GAINS 
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9. 7. 4. 2 TVC.  Gimballed  (continued) 


4.  ACTUATOR  DYNAMICS 

The  nonlinearities  of  the  actuator  dynamics  must  be  studied  care- 
fully before  proceeding  with  the  software  design.  A block  diagram  of 
the  actuator,  based  on  the  data  given  in  the  preceeding  section  of  this 
report,  is  shown  in  Figure  4.  Although  the  actuator  can  be  represented 
simply  at  low  frequencies,  it  actually  represents  an  aggregate  of  elec- 
tronic, hydraulic  and  mechanical  devices  which  cause  a large  number  of 
lags  and  nonlinearities  at  higher  frequencies.  The  limits  will  be 
assumed  to  be  representative  of  all  such  lags  and  nonlinearities  at  the 
lower  frequencies. 

The  limits  given  in  Reference  1 for  the  Shuttle  were  compared  with 
those  for  the  Apollo  SPS.  The  deflection  and  rate  limits  are  comparable, 
but  the  acceleration  limit  is  only  a small  fraction  of  the  SPS  equivalent. 
The  specified  minimum  output  torque  of  the  SPS  actuator  was  sufficient  to 

p 

guarantee  an  angular  acceleration  of  3.5  radians/sec  , which  is  about 
6 times  that  indicated  for  the  Shuttle. 

Reference  1 gives  the  length  of  the  engine  as  only  6 ft  (75")  which 
would  indicate  a moment  of  inertia  of  only  about  90  slug-ft2  based  on 
SPS  data.  A moment  arm  of  0.6  ft  should  be  attainable.  If  these  assump- 
tions are  reasonable,  the  lateral  force  required  to  achieve  the  indicated 
acceleration  limit  is  in  the  100-pound  neighborhood.  Such  a small  force 
would  appear  to  be  in  the  vibration  noise  level  of  a 10,000  lb.  engine 
mounted  on  gimbals.  The  tai 1-wags-dog  effect  is  not  serious. 

The  servo-amp/torquer  gain,  K,  and  the  tachometer  feedback  gain, 

KR‘  are  not  specified.  Without  limiting,  the  linear  transfer  function 
for  the  actuator  in  Figure  4 is  as  follows: 

— = K 

6C  s2  + KrKs  + K 
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FIGURE  4 
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The  linear  natural  frequency  is 


= VT 

but  this  frequency  is  the  bandpass  for  input  amplitudes  of 

A < 35/K 

For  larger  amplitudes,  limiting  will  reduce  the  bandpass  of  the  actuator. 
The  gain  proposed  by  NR  can  be  taken  as  an  example;  for  K = 625: 

= 25  rad/sec 
A = 0.056  deg. 

If  we  assume  K is  infinite,  or  that  the  input  amplitude  is  infinite,  the 
maximum  output  amplitude  achievable  is  only  0.070  deg  at  25  rad/sec. 

These  amplitudes  are  so  small  that  the  actuator  will  be  operating  as  a 
bang-bang  system  at  nearly  all  input  amplitudes.  The  signal-to-noise 
ratio  of  the  tach  and  LVDT  feedbacks  will  probably  be  too  low  at  these 
amplitudes  and  frequencies  to  justify  the  wide  bandpass  and  high  gain. 

In  order  to  evaluate  the  actuator  performance  for  all  frequencies 
and  amplitudes,  it  is  necessary  to  determine  the  frequency  response 
characteristics  of  all  three  limits.  The  first  step  is  to  determine  the 
maximum  output  as  a function  of  frequency  for  each  of  the  limits  sepa- 
rately. The  maximum  output  due  to  the  deflection  limit  is,  of  course, 
given  as 


6max  4°  (6limit) 

The  maximum  amplitude  of  output  deflection  assuming  a bang-bang  rate 
limit  of  7 deg/sec  is 


6MAX  = 7t 

where  t is  one-fourth  the  period,  or 


6max  = 110/u  ^6LIMIT^ 
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9. 7. 4. 2 TVC.  Gimballed  (continued) 


Finally,  the  maximum  output  for  a bang-bang  acceleration  limit  of 
2 

35  deg/sec  is 

6max  = \ ^ tZ 

6MAX  = 43,2°/a>2  ^LIMIT^ 

By  this  process,  we  are  able  to  convert  all  three  limits  to  deflection 
limits  as  a function  of  frequency.  These  output  amplitude  limits  are 
plotted  in  Figure  5. 

Figure  5 shows  that  an  input  of  4 degrees  will  yield  an  output  of 
4 degrees  out  to  about  2.5  rad/sec.  Additional  computations  show  that 
some  rate  limiting  will  occur  between  2.39  and  7.85  rad/sec;  however, 
the  acceleration  limit  begins  to  dominate  beyond  4 rad/sec.  At  10  rad/sec, 
unity  gain  cannot  be  achieved  for  amplitudes  greater  than  0.41  degree; 
this  is  unfortunate  because  large  quantities  of  energy  can  be  dissipated 
in  the  servo/torquer  as  a result  of  bending  frequency  (7.8  to  9.4  rad/sec) 
inputs  from  the  control  system  if  limiting  occurs.  In  addition,  phase 
shift  will  be  added  to  the  rate  loop  at  the  bending  frequencies  if  this 
type  of  limit  is  encountered. 

The  natural  frequency  of  the  actuator  was  chosen  as  10  rad/sec  for 
two  reasons;  first,  the  rate  loop  must  be  designed  to  cope  with  actuator 
nonlinearities  starting  at  2.5  rad/sec,  and  second,  the  output  amplitude 
is  only  10  percent  of  maximum  deflection  at  that  frequency.  The  damping 
ratio  was  arbitrarily  chosen  as  0.5,  which  yields  a linear  transfer 
function  and  gains  as  follows: 

5 = 100 

6C  s2  + 10s  + 100 

K = 100/sec2 

= 0.1  sec 

The  effects  of  the  finite  servo/torquer  gain  and  multiple  limits  were 
added  to  the  rigid  limit  boundaries  in  Figure  5 to  obtain  the  curve 
labeled  "Final  Boundary". 
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FIGURE  5 

ACTUATOR  LIMITS  VS.  FREQUENCY 
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FREQUENCY  (RAD/SEC) 


9. 7. 4. 2 TVC.  Gimballed  (continued) 


For  a given  input  amplitude,  the  gain  will  be  unity  (zero  db)  as 
long  as  the  output  level  remains  below  the  "Final  Boundary"  curve  in 
Figure  5.  By  drawing  zero  db  gain  lines  for  selected  input  amplitudes 
(horizontal  lines  in  Figure  5),  a family  of  gain  curves  is  obtained  as 
shown  in  Figure  6. 

The  phase  curves  in  Figure  6 were  obtained  by  studying  the  input  and 
output  wave  forms  during  the  limiting  process.  Standard  curves  can  be 
used  for  phase  shift  during  linear  operation.  When  severe  acceleration 
limiting  occurs  at  high  frequencies  (above  7.85  rad/sec),  and  large 
amplitudes  (one-half  deg/sec),  the  phase  shift  is  near  180  degrees  due 
to  the  bang-bang  effect.  If  rate  limiting  occurs,  an  equation  for  phase 
shift  is  required  as  a function  of  the  amplitude  ratio  and  the  input 
frequency.  This  equation  will  be  derived  with  the  aid  of  Figure  7. 

In  Figure  7,  the  output  deflection  is  plotted  against  output  phase, 
and  the  input  is  defined  by  a variable  phase.  The  feedback  and  output 
differ  by  a fixed  bias  during  rate  limiting,  and  this  curve  is  also 
plotted.  The  rate  limiting  will  end  when  the  input  a!nd  feedback' are 
equal  as  shown  by  the  circled  point  in  Figure  7;  the  acceleration  changes 
sign  and  nulls  the  rate  in  0.2  sec.  (Bang-bang  acceleration  is  assumed; 
no  error  is  introduced  by  this  assumption  for  reasons  given  later). 

The  equations  applying  at  the  acceleration  switch  point  circled  in 
Figure  7 are  as  follows: 

6 = 6pK  - (35/2) (0.2)2 
6=7  deg/sec 
6 + 0. 1 6 = 6pK 
A Sin  (*jn)  * 6pK 
$in  = * " arcsin  (6pK/A) 

W = f"  0,2w 

^ " ^out  " ‘Nn 
$ = arcsin  (6pK/A)  - j - | 

(2.4  < w < 7.8  rad/sec) 
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9. 7. 4. 2 TVC.  Gimballed  (continued) 


FIGURE  6 

ACTUATOR  FREQUENCY  RESPONSE 
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FIGURE  7 

PHASE  LAG  IN  ACTUATOR 
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9. 7. 4. 2 TVC.  Gimballed  (continued) 


The  last  equation  yields  the  phase  shift  plotted  in  Figure  6 based  on  the 
gain  ratios  of  the  same  figure.  (Note  that  the  arcsin  term  contains  the 
gain  ratio,  6pK/A,  which  has  been  modified  to  reflect  the  attenuation  and 
lag  due  to  employing  a finite  gain;  hence,  the  bang-bang  acceleration 
switching  assumption  is  correct). 

In  this  design  study,  the  selected  actuator  was  not  well  suited  to 

vehicle  stabilization  by  engine  gimballing  alone.  A minimum  actuator 

o 

acceleration  limit  of  1.5  radians/sec  would  alleviate  many  of  the  design 
problems  encountered  in  this  study.  The  phase-shift  discontinuities  at 
the  bending  frequencies  that  result  from  the  baseline  actuator  design 
may  prevent  phase  stabilization  of  the  control  system  if  a bending 
instability  problem  develops  in  the  later  stages  of  the  program  develop- 
ment. Notch  filters  may  be  required  in  the  control  system  to  prevent 
large  bending  amplitudes  from  reaching  the  actuator  input. 
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9. 7. 4.2  TVC,  Gimballed  (continued) 


5.  RATE  LOOP  DESIGN 

The  controllability  of  the  vehicle  for  rate  loop  design  is  bounded 
by  the  actuator  limits  multiplied  by  the  vehicle  dynamics  gain  Tji/I.  The 
deflection  limit  must  be  reduced  by  +0 . 23  degree  because  of  variations 
in  the  location  of  the  vehicle  eg;  other  errors  are  known  to  exist 
between  the  intended  null  alignment  and  the  physical  trim. deflection,  but 
no  data  is  available  on  these  biases.  The  total  null  bias  is  estimated 
at  0.4  degree,  which  leaves  3.6  degrees  for  control  deflection;  multiply- 
ing by  TJt/I,  we  obtain  the  vehicle  rate  control  capability  as  follows: 

0 = 3.6(0.06)  = 0.216  deg/sec^ 

This  controllability  function  defines  the  step  time  response  and  ramp- 
input  response  of  the  optimum  control  system  designed  for  this  vehicle 
configuration.  For  example,  the  time  response  to  a step  input  of  one 
degree/second  might  be  specified  as  5 seconds;  the  rate  errors  resulting 
from  ramp  inputs  of  up  to  0.2  deg/sec  might  be  specified  as  0.2  deg/sec 
(assuming  a maximum  actuator  step-response  of  one  second). 

The  frequency  response  of  the  rate  loop  is  probably  more  important 
than  the  controllability  available.  The  primary  reason  for  having  a rate 
loop  is  to  damp  thrust  vector  oscillations;  hence,  performance  boundaries 
must  be  determined  for  the  rate  loop  as  a function  of  frequency.  This 
analysis  can  be  accomplished  by  the  method  used  for  determining  the  per- 
formance boundaries  for  the  actuator  in. the  preceding  section. 

The  limits  on  vehicle  body  rates  can  be  obtained  by  converting  each 
of  the  actuator  limits  to  limits  on  the  first  three  derivatives  of  body 
rate  and  then  integrating  one  additional  time  to  obtain  body  rates.  That 
is,  apply  the  transfer  function 

Q/6  = -0.06/s  per  sec 
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to  the  maximum  actuator  response.  When  the  actuator  limits  are  multiplied 
by  the  gain,  the  limits  become: 

0^  = +.0 . 24  deg/sec^ 

0^  = +0.42  deg/sec^ 

*0^  =+2.10  deg/sec^ 

The  maximum  output  vehicle  rates  are  obtained  by  integration  over  the 
quarter-cycle  as  follows: 

0MAX  = 24) (it/ 2u ) [6  limit] 

0MAX  = 0/2)  (0.42)  (tt/2co)2  [5  limit] 

0MAX  = 0/6)(2.1)(./2u>)3  [6  limit] 

These  individual  rate  boundaries  are  plotted  as  solid  lines  in  Figure  8. 
The  boundary  representing  the  combination  of  limits  is  labeled  "MAX. 
VEHICLE  RATES".  The  curve  labeled  "0.32  DEG/SEC"  was  selected  as  the 
linear  design  goal  because  of  the  rapid  loss  of  bandpass  beyond  one 
radian/sec. 

The  maximum  control  response  to  the  bending  frequency  of  8 radians/ 
sec  is  about  0.0025  deg/sec  peak  rate.  Assuming  second-order  attenuation 
above  one  rad/sec,  the  input  from  the  rate  gyro  would  have  to  be  0.16 
deg/sec  to  produce  saturation  at  the  bending  frequency.  The  damping  pro- 
vided by  the  structure  would  have  to  be  about  0.015  to  prevent  the  possi- 
bility of  control  instability;  this  requirement  assumes  that  the  control 
feedback  is  shifted  180°.  The  additional  lag  provided  by  the  linear 
actuator  at  10  rad/sec  should  eliminate  most  of  the  effects  of  linear 
control.  Regardless  of  whether  the  control  system  stabilizes  or  desta- 
bilizes, the  effect  of  control  on  bending  will  not  be  spectacular. 

One  more  requirement  must  be  recognized  before  completing  the  rate 
loop  design.  The  rate  error  should  ideally  be  used  to  generate  a vehicle 
angular  acceleration  comnand  proportional  to  the  force  required;  for 
engine  gimballing  we  must  convert  the  angular  acceleration  comnand  to  an 
engine  deflection  command  as  follows: 

6C  = 6TRIM  " K0C 
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FIGURE  8 
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9. 7. 4. 2 TVC . Gimballed  (continued) 


The  bias  term  6TRIM  can  only  be  estimated  before  the  burn;  however,  if 
ec  is  biased  in  one  direction  for  a long  period  of  time,  it  is  safe  to 
transfer  the  bias  to  6TRIM  regardless  of  the  true  source  of  the  bias. 

The  transfer  is  obtained  as  follows: 

• 6TRIM  = 6EST  ~ V f K®C  dt 
6C  = 6EST  “ ^ s + 1 ) K®c 

The  input  sEST  is  important  because  errors  in  the  estimated  engine  trim 
will  result  in  control  transients,  the  only  source  of  velocity  errors 
computed  during  the  burn.  The  transfer  function  sought  for  trim  estima- 
tion is: 


The  closed  loop  linear  bandpass  of  the  rate  loop  was  determined  from 
the  limit  plots  of  Figure  8.  In  addition,  several  open  loop  requirements 
and  characteristics  have  been  determined;  they  are: 

1)  The  vehicle  dynamics 

2)  The  linear  actuator  dynamics 

3)  The  desired  phase  lag  at  the  bending  frequency 

4)  The  form  of  the  trim  estimation  transfer  function 

5)  The  attenuation  of  the  bending  frequency. 

The  only  characteristics  of  the  open  loop  that  can  be  varied  are  the 
sample  frequency,  the  lead  term,  K' , in  the  trim  estimation,  the  loop 
gain,  and  the  form  of  the  filter. 

The  sampling  frequency  was  arbitrarily  set  at  10  samples  per  second. 
Lower  frequencies  may  be  possible,  but  the  increased  D/A  filtering  that 
would  be  required  at  the  actuator  interface  is'  not  an  attractive  prospect. 
This  frequency  is  also  compatible  with  reaction-jet  control,  which  will 
be  considered  in  conjunction  with  engine  gimballing  in  the  Final  Design 
Phase  of  this  study. 
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The  form  of  the  filter  was  determined  by  assuming  a second-order  lag 
with  a first-order  lead. term;  that  is 

s + A 

s2  + Bs  + C 

This  form  provides  the  maximum  flexibility  in  controlling  the  phase/gain 
relationships  by  changing  the  damping  and  break  frequencies.  This 
process  is  mostly  "trial  and  error".  The  result  was  an  overdamped  filter 
that  could  easily  be  replaced  with  a first-order  lag;  underdamped  filters 
produced  a closed-loop  that  did  not  fit  the  limit  curve  in  Figure  8. 

The  selection  of  a first-order  lag  filter  left  only  three  remaining 
parameters  to  be  determined;  the  gain,  the  filter  time  constant,  and  the 
trim  integrator  break  frequency,  K'.  The  signal  compensation  in  the  rate 
loop  takes  the  form: 


The  vehicle  and  actuator  dynamics  feedback  is: 


The  product  of  these  two  transfer  functions  constitutes  the  complete  open 
rate  loop  transfer  function;  however,  the  sampling  delay  must  be  added  to 
the  phase  lag  (<j>  = 57.3  co/20) . The  three  remaining  parameters  can  be 
determined  in  various  ways  depending  on  the  effect  desired. 

The  selection  of  these  last  three  parameters  for  the  basic  pre- 
liminary design  was  based  on  the  following  objectives: 

1)  Maximize  the  high-frequency  gain  to  the  structural 
filtering  requirement  of  30  db  at  8 rad/sec. 

2)  Maintain  a phase  lag  of  270  degrees  at  the  bending 
frequency. 

3)  Separate  the  trim  bias  frequency  (K')  from  the  filter 
frequency  (1/x)  by  a factor  of  10. 
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9. 7.4-2  TVC . Gimballed  (continued) 


Only  14  degrees  phase  lead  was  needed  to  bring  the  total  phase  lag  down 
to  the  minimum  of  270  degrees  at  the  bending  frequency;  this  determined 
that  the  lead-lag  should  be: 

s + 0.2 

s + 2.0 

The  gain  Kp  was  then  determined  by  plotting  the  amplitude-ratio  curve 
and  computing  the  gain  required  for  the  30  db  attenuation.  The  result 
is  Kp  = 21 . 5 sec. 

The  frequency  response  of  the  rate  loop  is  shown  in  Figure  9 for  both 
the  open  and  closed  loops.  The  rate  loop  compensation  developed  above 
appears  at  the  right  in  the  block  diagram  in  Figure  10.  The  closed  loop 
bandpass  in  Figure  9 is  higher  than  the  curve  sketched  in  Figure  8;  the 
faster  rate  loop  is  desired  for  the  initial  response  to  ignition  tran- 
sients but  will  increase  the  range  of  nonlinearity  in  the  rate  loop.  The 
curve  in  Figure  8 can  be  approximated  by  reducing  the  gain  Kp  by  a factor 
of  two,  if  bandwidth  is  less  important  than  linearity. 

The  limit  of  +1  deg/sec  on  the  steering  rate  commands  was  selected 
based  on  the  time  required  to  remove  the  command  rate  (about  5 seconds). 
This  limit  could  probably  be  reduced  by  a factor  of  10  in  order  to 
eliminate  the  possibility  of  actuator  saturation  due  to  steering.  The 
maximum  steering  command  under  normal  (non-fail)  operation  is  expected 
to  be  about  0.25  deg/sec  due  to  the  low  thrust  acceleration.  The  next 
section  will  discuss  the  steering  system  further. 

The  roll -axis  control  is  a simple  rate-damper.  Because  no  attitude 
control  is  required  in  roll,  the  rate  loop  bandpass  can  be  reduced  by 
lowering  the  gain  to  5 sec  compared  to  21.5  sec  for  pitch/yaw.  No  rate 
filter  is  required  with  the  lower  gain.  The  requirement  for  roll  damp- 
ing stems  from  the  probability  that  the  two  pitch  actuators  will  have 
different  trim  biases.  The  roll  torque  is  the  difference  between  the 
pitch  torques  supplied  by  the  two  engines.  The  pitch  control  responds 
only  to  the  sum  of  the  pitch  torques;  hence,  the  roll  rate  loop  is 
required  to  compute  a differential  command  to  the  pitch  actuators.  A 
trim  integtator  is  included  in  roll  to  allow  the  roll  rates  to  decrease 
as  the  burn  progresses. 
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FIGURE  10 

BLOCK  DIAGRAM  OF  SOFTWARE  DESIGN 
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9. 7. 4*2  TVC.  Glmballed  (continued) 


6.  STEERING  LOOP  DESIGN 


The  configuration  of  steering  loop  is  shown  on  the  left  in  Figure  10.- 
For  the  purpose  of  this  preliminary  design,  it  was  assumed  that  the 
accelerometers  are  mounted  on  a stable  platform.  The  steering  variables 
shown  in  Figure  10  are  merely  symbolic  of  the  pitch  (Z-axis)  components 
of  the  steering  variables  that  would  be  contained  in  the  flight  computer. 
The  guidance  input  is  a constant  Delta-V  command  used  as  a directional 
reference  for  thrust  vector  control;  has  no  Z component,  by 

definition,  and  is  shown  in  Figure  10  only  to  indicate  the  summation 
point  for  the  comparison  of  velocity  vectors.  Vector  steering  commands 
are  resolved  into  body  rates  before  limiting. 

The  steering  loop  can  be  represented  as  three  transfer  functions  and 
a delay.  The  transfer  function  for  the  steering  computation  is: 


The  transfer  function  for  the  vehicle  dynamics  was  given  previously  as: 

A /e  = -0-1207(s2  - 0-3141 

znr  s 

The  closed  rate  loop  is  represented  by  Figure  9 and  could  be  equated  to 
the  following  transfer  function: 

0/ec  = 2 . 1 8/ ( s 2 + 1.48s  + 2.18) 

A sample  period  of  two  seconds  was  selected;  the  maximum  period  for  the 
selected  vehicle  is  about  5 seconds.  The  sampling  lag  is  one  second 
(<f>  = 57. 3u>). 

The  most  troublesome  feature  of  the  steering  loop  design  is  the 
location  of  the  accelerometers  relative  to  the  eg.  The  vehicle  dynamics 
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9. 7. 4. 2 TVC.  Gimballed  (continued) 


shown  in  Figure  3 yield  the  general  transfer  function  for  acceleration 
measurement  {in  ft/sec  per  radian),  as  follows: 

Azm/6  = T/m  - (T*/I)Ua  + T/m  s2) 

Using  the  nominal  values  from  Table  2 for  T/m  and  Tji/I,  we  obtain  a 
function  of  the  accelerometer  moment  arm: 

Azm/6  = (-.06/s2)  [UA  - 36. 2)s2  + 2.17] 

The  coefficient  (a,  - 36.2)  arises  from  having  both  the  sensor  and  center 
of  thrust  application  at  stations  different  from  the  eg. 

If  the  accelerometers  are  located  more  than  36.2  feet  forward  of  the 
eg,  the  steering  will  respond  too  much  to  vehicle  angular  accelerations. 
If  the  accelerometers  are  located  too  near  the  eg  location,  the  steering 
will  respond  too  much  to  gimbal  angle  transients  which  are  opposite  in 
sign  to  the  vehicle  angular  acceleration.  Either  way,  these  signals 
change  so  rapidly  that  the  next  two-second  steering  command  should  not 
be  affected  by  them.  The  ideal  location  of  the  accelerometers  is 
36.2  feet  from  the  eg.  The  location  assumed  is  seven  feet  aft  of  the 
ideal  station  to  allow  for  eg  changes  and  practical  limitation  on  place- 
ment of  the  sensor  in  the  vehicle.  Less  favorable  locations  will  require 
compensation  in  the  steering  loop. 

The  acceleration  gain,  K^,  is  determined  by  the  rate  loop  resonant 

peak  at  1.2  rad/sec,  and  the  velocity  error  gain,  K<-,  determines  the 

bandpass  of  the  closed  steering  loop.  The  open  steering  loop  frequency 

response  is  shown  in  Figure  11.  Because  the  180°  phase  occurs  near  the 

rate  loop  peak,  the  open  loop  gain  should  be  less  than  -6  db  in  that 

region;  otherwise,  the  closed  steering  loop  will  contain  a resonance  at 

the  higher  frequency.  The  peaking  of  the  gain  curve  is  chiefly  due  to 

the  measurement  zero  at  0.56  rad/sec,  which  result  from  the  non-optimum 

location  of  the  accelerometers.  The  gain  required  is  1.5  deg/sec  per 
2 

ft/sec  (0.84  rad/sec  per  g). 

The  selection  of  the  steering  gain,  K^,  was  made  on  the  basis  that 
the  closed  steering  loop  requires  a 6 db  resonance  in  order  to  achieve 
the  faster  response  without  causing  overshoot  in  the  velocity  error.  The 
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9. 7. 4. 2 TVC.  Gimballed  (continued) 


FIGURE  11  . 

OPEN  STEERING  LOOP  FREQUENCY  RESPONSE- 
(Open  at  accelerometer  output  or  at  limiter  in  Figure  10) 
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9.7. 4.2  TV C.  Gimballed  (continued) 


value  selected  for  K$  was  1/(10  seconds)  which  produces  the  closed-loop 
frequency  response  shown  in  Figure  12. 

The  large  resonant  peak  at  the  low  frequency  in  Figure  12  would  be 
interpreted  as  a massive  overshoot  in  response  to  step  guidance  inputs. 
This  is  true.  As  mentioned  previously,  this  design  assumes  External 
Delta-V  guidance  which  provides  for  no  cross-axis  velocity  inputs.  The 
steering  loop  is  designed  to  respond  to  ramp  velocity  errors  which  will 
develop  during  attitude  stabilization.  The  amplitude  peak  at  one  rad/sec 
is  a disturbance  resulting  from  the  intrusion  of  angular  accelerations 
into  the  steering  measurement. 

The  chief  input  is  expected  to  result  from  residual  alignment 
errors  from  the  ACPS  at  the  start  of  the  burn.  The  ideal  relationship 
between  the  ACPS  phase  plane  errors  would  be: 

E = -(2  seconds)  E 

This  relationship  would  align  the  vehicle  properly  during  the  first 
two-second  steering  cycle.  The  next  steering  command  should  contain 
a small  pointing  error,  but  the  remaining  commands  will  be  mostly  a 
result  of  velocity  errors  during  the  first  three  seconds.  The  first 
steering  command  is  input  at  ignition  as: 

0q  = Ep/2  (Limit  = 1 deg/sec) 

ACPS  attitude  errors  greater  than  0.2  degree  will  produce  actuator  limit- 
ing, but  such  large  errors  are  not  ancticipated. 

Engine  trim  estimation  errors  will  also  result  in  pointing  errors, 
but  these  errors  will  be  smaller  because  of  the  low  angular  acceleration 
resulting  from  the  low  thrust-to-inertia  ratio.  Thrust  vector  errors 
due  to  a one  degree  initial  trim  error  would  be  about  0.02  degree.  Peak 
velocity  errors  from  both  sources  is  expected  to  be  about  0.04  ft/sec. 
This  level  of  measurement  will  require  more  accurate  accelerometers  than 
used  on  Apollo  because  of  the  low  thrust  acceleration.  The  effect  of 
thrust  on  sensor  requirements  is  the  topic  of  the  following  section. 
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9. 7. 4.2  TVC,  Gimballed  (continued) 


BLOCK  12 

CLOSED  STEERING  LOOP  FREQUENCY  RESPONSE 
(Unity  Feedback) 


FREQUENCY  (RAD/SEQ 


9.7-177 


PHASE 


9. 7. 4. 2 TVC.  Gimballed  (continued) 


7.  SENSOR  REQUIREMENTS 

Sensor  characteristics  were  not  considered  as  inputs  to  the  pre- 
liminary design.  This'  design  assumed  that  the  accelerometer  and  rate 
gyro  thresholds  would  be  as  low  as  required.  The  burn  accuracy  obtainable 
with  the  preliminary  design  for  the  vehicle  described  in  Section  3 of 
this  report  is  about  0.01  ft/sec.  The  accelerometer  threshold  required 
to  obtain  this  burn  accuracy  is  about  10"4  g (0.003  ft/sec2)  or  a two- 
second  velocity  increment  of  0.006  ft/sec.  The  Apollo  LM  accelerometers 
generate  torque  pulses  at  the  10‘4  g level,  but  the  output  velocity 
increments  are  too  large  (0.0328  ft/sec).  Future  thrust  vector  control 
studies  should  consider  the  effects  of  larger  accelerometer  thresholds 
than  required  by  the  preliminary  design. 

Guidance  studies  should  be  performed  to  determine  the  portion  of  the 
velocity  error  budget  that  is  allocated  to  thrust  vector  control.  This 
study  reveals  that  the  precision  of  the  accelerometer  measurements  will 
probably  be  more  significant  than  the  control  scheme  error  for  the  low- 
thrust  vehicle.  As  a result,  preliminary  estimates  of  thrust  vector 
control  errors  can  be  directly  related  to  the  accelerometer  characteristics. 

The  rate  gyro  requirements  are  also  a function  of  required  burn 
accuracy  as  well  as  control  factors.  The  preliminary  design  would  require 
a rate  gyro  threshold  of  about  0.005  deg/sec  and  a linear  range  of  +1.5 
deg/sec.  If  bending  stability  can  be  ignored  due  to  low  thrust  or  the 
slow  actuator  response,  the  rate  gyro  threshold  can  be  raised. 
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8.  SOFTWARE  EQUATIONS 

The  equations  appearing  in  this  section  are  intended  for  implementa- 
tion on  the  Space  Shuttle  Functional  Simulator.  These  equations  are 
equivalent  to  the  functions  indicated  in  Figure  10  and  assume  that  the 
vehicle,  actuator  and  sensor  dynamics  are  those  described  in  previous 
sections  of  this  report.  A top-level  flow  diagram  is  presented  in  Fig.  13. 

INPUTS:  The  inputs  are  defined  as  follows: 

Voq  Desired  velocity  increment  in  stable 

member  coordinates. 

aV  Accelerometer  interface  unit  outputs  in 

stable  member  coordinates  accumulated  over 
a two-second  steering  cycle. 

A Measured  acceleration. 

[*SMB*]  Rate  transformation  matrix  from  stable- 

member  to  body-axis  coordinates. 

• • « 

©_ , 4L , ‘f’m  Rate  9yro  interface  unit  outputs  in  body- 

axis  coordinates  (pitch,  yaw,  roll). 

^PEST’^YEST’^REST  En9ine  trim  deflection  estimates  (pitch, 

yaw,  roll);  input  about  5 seconds  prior  to 
ignition. 

X Vector  cross-product  multiplication. 

0,4'  Attitude  error  computed  by  ACPS. 

K Constants  as  given  below. 

CONSTANTS:  The  constants  below  are  equation  values  assuming  accelerometer 
outputs  in  ft/sec,  rate  gyro  outputs  in  deg/sec,  and  gimbal 
commands  in  degrees. 

K<j  = 0.1/sec 

=,  1.5  deg-sec/ft 

Kgp  = Kgy  = 4.73  sec 
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9. 7. 4.2  TVC,  Gimballed  (continued) 


'CP 


'RL 


Kcy  = 0.78 
0.02 
5.  sec 
1.  deg/sec 


INITIALIZATION: 

A6  n 


3ytrim 


RTRIM 


^VGO 

h 


A6y  = 0 


PTRIM  = PEST 


= 6 


= 6 


YEST 


REST 


^GO7 I VG0 I 

4o 


ENGINE  TRIM:  (Entered  5 seconds  before  ignition) 


6PL  = 6PTRIM  " 6 RTRIM 

6PR  = 5PTRIM  + 6RTRIM 

6yl  = 6YTRIM 

6YR  = 6YTRIM 


(P  = pitch,  Y = yaw,  L - left,  R = right  engine 
commands  are  outputs  to  the  engine  actuators  - | 
command  produces  negative  pitch,  yaw  on  vehicle 


IGNITION:  (Entered  after  engine  is  on) 

TSTEER  = 2.0  seconds 

°c  - °/2 

»(.  = v/2 

• • 

(Limit  ©c , Yc  to  +KR[_) 

Go  to  "RATE  LOOP" 


; these 
ositive 
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9. 7. 4*2  TVC,  Gimballed  (continued) 


RATE  LOOP:  (Entered  every  0.1  second) 


EP 

— 

0m  " Qr 
m C 

A6p 

= 

KgpEp  + 

6ptrim 

= 

6PTRIM  + KDA6P 

6PC 

= 

6ptrim  + A6P 

ey 

= 

• • 
m C 

A6y 

= 

KBYEY  + KCYa6Y 

6ytrim 

= 

6ytrim  + KDA6Y 

6yc 

= 

6ytrim  + a6r 

A6r 

= 

Krim 

Em 

6rtrim 

= 

6RTRIM  + KDA6R 

6rc 

6rtrim  + A6R 

6pl 

= 

6PC  " 6RC 

6pr 

= 

6PC  + 6RC 

6yl 

= 

6yc 

6yr 

= 

6yc 

TSTEER  = TSTEER  - 0.1  second 
If  TSTEER  £ 0,  perform  "STEERING" 

STEERING:  (Entered  every  2 seconds  during  burn) 


TSTEER 

= 2.0  seconds 

-S 

- x ^VGO 

& 

11 

KS  ^GO  X W 

II 

" -S 

RATE  = 

: ka  [*smb*]ea 
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9. 7. 4. 2 TVC.  Gimballed  (continued) 


STEERING:  (Continued) 

• • 

(gc  is  the  pitch  component  of  RATE,  vc,  the  yaw  component; 

the  third  component  is  not  used). 

• • 

Limit  the  magnitudes  of  ec  and  4<c  to  +KRL< 
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9. 7. 4. 2 TVC.  Gimballed  (continued) 


FIGURE  13 
FLOW  DIAGRAM 
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9. 7. 4. 2 TVC . Gimballed  (continued) 


9.  REVIEW 

The  preliminary  design  described  in  this  report  developes  a basic 
concept  of  thrust  vector  control  which  has  several  special  features;  for 
example: 

1)  Integration  of  steering,  stabilization  and  actuator 
loops. 

2)  No  direct  control  of  vehicle  attitude. 

3)  Constant-gain  steering  for  cross-axis  velocity 
control . 

4)  High-gain  engine  trim  estimater. 

5)  Design  for  maximum  linearity  using  bandpass  control. 

The  feasibility  of  performing  thrust  vectoring  with  the  selected  vehicle 
and  actuator  was  demonstrated,  although  the  damping  of  high-frequency 
oscillations  was  shown  to  be  impractical  with  the  low-performance  actuator 
specified. 

As  a result  of  this  design  study,  a minimum  actuator  acceleration 
2 

of  1.5  radians/sec  is  recommended  to  provide  the  gimbal  control  system 
with  the  capability  to  stabilize  slosh  and  bending  and  to  permit  more 
rapid  nulling  of  ignition  transients.  It  is  also  recommended  that  the 
accelerometer  threshold  be  considered  in  all  future  thrust  vector  control 
designs  for  low-thrust  vehicle  configurations. 

The  preliminary  design  was  successful  in  identifying  the  major 
problems  in  designing  a gimbal led-engine  TVC  system  for  the  shuttle. 

Some  of  these  problems  that  require  additional  investigation  are  listed 
below: 

1)  Stabilization  of  slosh  bending. 

2)  Quantization  effects  of  sensors. 

3)  Accelerometer  locations  requiring  compensation. 

4)  Minimum  sampling  frequencies. 

5)  Sensor  biases. 

6)  Combinations  of  reaction-jet  and  gimbal! ed- 
engine  control. 
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9. 7. 4.2  TVC.  Gimballed  (continued) 
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9.8  RENDEZVOUS  MISSION  PHASE 


The  rendezvous  mission  phase  begins  at  the  completion  of  orbit 
insertion  with  the  computation  of  the  rendezvous  plan . During  this 
coasting  period  of  time,  the  mission  planning  software  will  utilize 
the  rendezvous  targeting  routines  to  insure  that  the  insertion  cut-off 
conditions  (i.e.,  cut-off  state  vector)  are  within  the  rendezvous 
corridor  defined  by  pre-mission  and  crew  option  inputs.  When  a 
satisfactory  plan  is  established,  the  various  tasks  of  the  rendezvous 
will  be  assigned  a preliminary  schedule.  The  implementation  of  this  plan 
will  represent  the  remainder  of  the  rendezvous  mission  phase. 

The  SW  functions  required  in  this  mission  phase  are  the  following: 

1.  Estimate  relative  state  of  target  vehicle  based  on 
external  measurements  (if  available) . 

2.  Estimate  absolute  states  of  both  shuttle  and  target 
vehicle. 

3.  Target  the  rendezvous  AV's  required,  their  direction, 
and  the  time's  of  ignition. 

4.  Execute  rendezvous  maneuvers  by  commanding  engine's 
on,  providing  attitude  commands  during  the  maneuvers, 
and  commanding  engines  off. 

5.  Powered  flight  navigation. 

6.  Provide  RCS  engine  commands  to  achieve  commanded  attitude 
during  A V maneuvers  and  during  coast  periods  (digital 
autopilot) . 

7.  Provide  data  for  failure  analysis. 

8.  Provide  data  for  crew  display. 

The  guidance  and  navigation  software  during  the  burns  will  be  the  same 
as  described  in  Orbital  Powered  Flight.  The  estimates  of  absolute  states 
will  be  performed  as  described  in  Orbital  Coast. 

9.8.1  Targeting 
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SPACE  SHUTTLE 


GN&C  SOFTWARE  EQUATION  SUBMITTAL 

Software  Equation  Section;  Rendezvous  Targeting  Submittal  No.  21A 
Function:  Provide  targeting  solutions  for  rendezvous 

Module  No.  0G3  Function  No.  1.2. 3. A.  & 6 (MSC  03690  Rev. A) 

Submitted  by:  W.  H Tempelman  Co.  MIT  No.  7 (Rev.  1) 

Date:  21  October  1971 

NASA  Contract:  J.  Suddath  Organization:  GCD 

Approved  by  Panel  III  Date:  /QA  1 h \ 

Summary  Description:  This  submittal  represents  a single  targeting  program 

for  providing  targeting  parameters  to  powered  flight  guidance  for  all  of 
the  series  of  maneuvers  that  make  up  a rendezvous  sequence.  The  program 

can  handle  any  given  number  of  maneuvers.  Many  types  of  maneuver  con- 

straints  are  incorporated  in  the  program  such  that  virtually  any  sequence 
of  rendezvous  maneuvers  can  be  accommodated.  In  addition,  the  Astronaut 
is  provided  a large,  well-defined  series  of  options  by  which  he  may  mod- 
ify the  nominal  sequence. 

Shuttle  Configuration:  This  software  is  essentially  independent  of  the 

shuttle  configuration. 

Comments: 

(Design  Status)  

(Verification  Status)  

Panel  Comments: 

Revision:  A.  Original  submittal,  now  totally  replaced,  in  February  1971. 
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9. 8. 1.1  Rendezvous  Targeting 


1.  INTRODUCTION 

The  rendezvous  of  the  Orbiter  (primary  vehicle)  with  a target  vehicle  (e.  g. 
the  Space  Station)  is  accomplished  by  maneuvering  the  Orbiter  into  a trajectory 
that  intercepts  the  target  vehicle  orbit  at  a time  that  results  in  the  rendezvous  of 
the  two  vehicles.  The  function  of  rendezvous  targeting  is  to  determine  the  targeting 
parameters  for  the  powered  flight  guidance  for  each  of  the  maneuvers  made  by  the 
Orbiter  during  the  rendezvous  sequence. 

In  order  to  construct  the  multimaneuver  rendezvous  trajectory,  sufficient 
constaints  must  be  imposed  to  determine  the  desired  trajectory.  Constraints 
associated  with  the  Orbiter  mission  will  involve  such  considerations  as  fuel,  light- 
ing, navigation,  communication,  time,  and  altitude.  The  function  of  premission 
analysis  is  to  convert  these  — which  are  generally  qualitative  constraints-into  a set 
of  secondary  quantitative  constraints  that  can  be  used  by  the  onboard  targeting 
program.  By  judicious  selection  of  the  secondary  constraints,  it  should  be  possible 
to  determine  off-nominal  trajectories  that  come  close  to  satisfying  the  primary 
constraints. 

The  proposed  onboard  rendezvous  targeting  program  consists  primarily  of  a 
main  program  and  a generalized  multiple -option  maneuver  subroutine.  The  driving 
program  automatically  and  sequentially  calls  the  maneuver  subroutine  to  construct 
the  rendezvous  configuration  from  a series  of  maneuver  segments.  -The  main  pro- 
gram is  capable  of  handling  rendezvous  sequences  involving  any  given  number  of 
maneuvers.  Enough  different  types  of  maneuver  constraints  are  incorporated  into 
the  subroutine  to  provide  the  flexibility  required  to  select  the  best  set  of  secondary 
constraints  during  premission  planning.  In  addition,  the  astronaut  has  a large, 
well  defined  list  of  maneuver  options  if  he  chooses  to  modify  the  selected  nominal 
rendezvous  scheme. 

As  the  new  approach  represents,  in  essence,  just  one  targeting  program, 
there  is  considerable  savings  in  computer-storage  requirements  compared  to  former 
approaches  in  which  each  maneuver  used  in  the  rendezvous  scheme  had  a separate 
targeting  program.  The  programming  and  verification  processes  of  this  unified 
approach  will  also  result  in  implementation  efficiencies. 

1.  1 Number  of  Independent  Constraints  Involved  in  a 

Rendezvous  Sequence 

During  the  Gemini  and  Apollo  flights  and  in  the  design  of  the  Skylab  rendezvous 
scheme  various  numbers  of  maneuvers  were  utilized  in  the  rendezvous  sequence. 

The  range  went  from  two  (Apollo  14  and  15)  to  six  (Skylab). 
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9. 8. 1.1  Rendezvous  Targeting  (continued) 


The  number  of  independent  constraints  (i.  e.  , the  number  of  explicitly  satisfied  con- 
straints) in  each  rendezvous  sequence  must  equal  the  number  of  degrees  of  freedom 
implicitly  contained  in  the  sequence.  To  establish  this  number,  a rendezvous  con- 
figuration can  be  constructed  by  imposing  arbitrary  constraints  until  the  configura- 
tion is  uniquely  defined.  For  example,  a four  maneuver  coplanar  sequence  is 
shown  in  Figure  1,  followed  by  a coast  to  a terminal  point.  Using  the  constraints 
vi  (velocity  magnitude),  ri  and  0^,  it  is  easy  to  establish  that  the  total  number 
involved  is  12,  assuming  the  time  of  the  first  maneuver  has  been  established.  Re- 
moving one  maneuver  will  reduce  the  number  of  degrees  of  freedom  by  three. 

Hence,  the  number  of  independent  constraints  necessary  to  uniquely  determine  the 
maneuver  sequences  are 

Number  of  maneuvers  Number  of  independent 

in  sequence constraints  required 

1 3 

2 6 

3 9 

4 12 
etc 

If  the  above  rendezvous  are  not  coplanar,  one  additional  constraint  has  to  be  added 
to  each  sequence  to  allow  for  the  out-of-plane  component. 

In  some  cases  the  number  of  primary  constraints  may  be  insufficient  to 
uniquely  determine  a rendezvous  trajectory  for  the  desired  number  of  maneuvers. 
One  way  of  overcoming  this  deficiency  in  constraints  is  by  introducing  sufficient 
variables  to  complete  the  determination  of  the  rendezvous  trajectory  and  then 
determining  values  for  these  variables  by  minimizing  the  fuel  used. 

In  order  to  take  advantage  of  updated  state  vectors  due  to  navigation  or  ground 
updates,  the  rendezvous  targeting  program  is  called  prior  to  each  maneuver  to 
compute  the  upcoming  maneuver.  In  general,  each  maneuver  computation  will  in- 
volve a multimaneuver  sequence  as  the  nature  of  the  targeting  constraints  do  not 
allow  the  maneuvers  to  be  independently  computed.  These  sequences  must  have  the 
same  number  of  independent  constraints  as  tabulated  above. 

1.  2 The  Construction  of  a Maneuver  Segment 

Each  n-maneuver  sequence  can  be  divided  into  n-maneuver  segments.  Each 
segment  involves,  basically,  the  addition  of  a maneuver  to  the  primary  vehicle's 
velocity  vector  and  an  update  of  both  vehicle's  state  vectors  to  the  next  maneuver 
point. 

A maneuver  segment  can  be  generated  in  one  of  three  ways: 
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9. 8. 1.1  Rendezvous  Targeting  (continued) 


Terminal 


Figure  1.  A Possible  Set  of  Constraints  Involved  in 
a Four  Maneuver  Rendezvous  Sequence 
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9. 8. 1.1  Rendezvous  Targeting  (continued) 


Forward  generation 


Target  generation 


Integrated  generation 


A maneuver  A v is  computed  and  added 
to  the  velocity  vector  in  a specified  di- 
rection. The  state  vector  of  the  primary 
vehicle  is  then  updated  through  a speci- 
fied amount  to  arrive  at  the  next  maneu- 
ver position. 

The  target  vehicle  is  updated  through  a 
specified  amount  to  establish  a target 
vector  for  the  maneuver.  The  maneuver 
is  then  computed  by  uniquely  specifying 
the  nature  of  the  traverse  between  the 
primary  vehicle's  position  and  the  target 
vector. 

In  this  case,  the  maneuver  segment  is 
computed  as  an  integral  part  of  a ma- 
neuver sequence  involving  more  than 
one  maneuver  segment.  The  nature  of 
the  constraints  are  such  that  the  ma- 
neuver sequence  cannot  be  subdivided 
into  uniquely  defined  maneuver  seg- 
ments. The  maneuver  segment  will 
usually  have  one  degree  of  freedom, 
which  will  generally  be  assumed  to  be 
the  magnitude  of  the  maneuver. 


Each  of  the  above  methods  is  defined  by  the  specification  of  three  trajectory 
constraints  (four  in  the  case  of  noncoplanar  traverses).  Before  introducing  the 
maneuver  constraints  associated  with  the  three  ways  of  generating  a maneuver 
segment,  the  constraints  associated  with  updating  a state  vector  will  be  listed. 
These  constraints  are  specified  with  the  update  switch  s upcjate 


S update 


1 

2 

= 3 

4 

5 


Update  from  time  t to  time  tp 

Update  through  time  interval  At 

Update  through  n revolutions 

Update  through  0 radians 

Update  to  be  colinear  with  a 
specified  position  vector 
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9. 8. 1.1  Rendezvous  Targeting  (continued) 


In  the  remainder  of  this  section,  the  choice  of  a maneuver  option  is  equivalent 
to  the  selection  of  a constraint. 

1.  2.  1 Maneuver  Options  in  Forward  Generation  of 
Maneuver  Segment 


The  forward  generation  of  a maneuver  segment  is  accomplished  in  one  of  two 
ways.  Either  the  maneuver  magnitude  is  uniquely  determined  in  terms  of  the  state 
vector  at  the  maneuver  time  or  the  maneuver  is  determined  by  an  iterative  search 
to  satisfy  a terminal  constraint. 

The  maneuver  magnitude  Av  is  either  calculated  or  assumed  depending  on 

the  maneuver  switch  s , and  it  is  applied  in  a direction  controlled  by  the  di- 
man J 

rection  switch  s ,.  . . The  options  associated  with  the  maneuver  switch  are: 

direct  ^ 

A v is  assumed  specified 

Av  is  computed  based  on  a post  maneuver 
velocity  vector  being  "coelliptic"  with  the 
state  vector  of  the  target  vehicle 

A v is  computed  from  the  conic  circular 
velocity  constraint 

A v is  computed  based  on  a Hohmann  type 
transfer  resulting  in  a Ah  change  in 
altitude 


s = J 
man  \ 


The  options  associated  with  the  maneuver  direction  switch  are  : 


r-l 


s direct  ' 


-2 


Apply  Av  is  horizontal  direction  in  plane 
of  primary  vehicle 

Apply  Av  in  horizontal  direction  parallel 
to  orbital  plane  of  the  target  vehicle 

Apply  Av  along  velocity  vector  in  plane 
of  primary  vehicle 

Apply  Av  along  velocity  vector  parallel 
to  orbital  plane  of  the  target  vehicle 


The  selection  of  the  update  switch  s Upjate  determines  the  update  of  the 
primary  vehicle's  trajectory  following  the  maneuver  to  the  position  of  the  next 
maneuver.  A terminal  constraint  can  be  imposed  at  this  point  by  setting  the  ter- 
minal switch  s . : 

term 
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9. 8. 1.1  Rendezvous  Targeting  (continued) 


s term 


Terminal  constraint  is  a height  constraint 
Terminal  constraint  is  a phasing  constraint 


Following  the  computation  of  the  height/ phasing  error,  the  maneuver  magnitude  is 
varied  in  an  iterative  search  to  satisfy  the  height/phasing  constraint. 

1.  2.  2 Maneuver  Options  in  Target  Generation 
of  Maneuver  Segment 


The  target  generation  of  a maneuver  segment  starts  with  the  selection  of 
the  update  switch  for  the  target  vehicle.  If  this  switch  equals  four,  0 will  be 
augmented  by  the  central  angle  between  the  primary  and  target  vehicles  before 
being  used.  The  nature  of  the  traverse  between  the  primary  vehicle's  initial  state 
vector  and  the  updated  position  of  the  target  vehicle  is  controlled  by  the  maneuver 


12  Establish  a primary  vehicle's  position 
vector  by  solving  the  TPI  geometry 
problem  based  on  e and  Ah  (see 

1-J 

Desired  Position  Routine  in  Section  5 
and  Figure  2).  Compute  the  primary 
vehicle's  coelliptic  velocity  at  this 
point.  Update  this  state  vector  through 
A t to  establish  the  target  vector. 
Compute  Lambert  solution  to  establish 
maneuver. 


Sman  = T 1 3 Establish  a target  vector  by  solving  the 

TPI  geometry  problem  based  on  e^  and 
A h . Compute  Lambert  solution  to  estab- 
lish maneuver. 

(Before  calculating  the  following  maneuvers, 
the  target  position  vector  is  offset  Ar  and 
Ah.) 


14  Compute  Lambert  solution  to  establish 
maneuver. 
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9. 8. 1.1  Rendezvous  Targeting  (continued) 


[ = Unit  horizontal  in  forward  direction  for  primary  vehicle 

LOS  = Line  of  Sight 

1.  If  the  LOS  projection  on  [ is  positive  •. 

a.  When  the  LOS  is  above  the  horizontal  plane.  0 < e|_ < 7r/  2 

b.  When  the  LOS  is  below  the  horizontal  plane,  3tt/  2 < eL<  2ir 

2.  If  the  LOS  projection  on  [ is  negative  : 

a.  ' When  the  LOS  is  above  the  horizontal  plane,  7 r/  2<e^  < n 

b.  When  the  LOS  is  below  the  horizontal  plane,  7r<  eL  < 3tt/  2 


Figure  2.  Definition  of  the  Elevation  Angle  e 

5 Lj 
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9. 8. 1.1  Rendezvous  Targeting  (continued) 


21  Compute  a horizontal  maneuver  to  hit  the 
target  aimpoint. 


s = J 22 
man  a 

(cont. ) | 


23 


Compute  a maneuver  along  the  velocity 
vector  to  hit  the  target  aimpoint. 

Compute  maneuver  to  establish  perigee/ 
apogee  at  target  aimpoint. 


There  is  a minimum  Av  option  associated  with  maneuvers  s = 12  and 
14.  This  option  is  controlled  with  the  optimum  switch  s^  : 

f' 

-1  Minimize  the  magnitude  of  the  first  ma- 
neuver by  varying  A1  > the  time  of  up- 
date of  the  target  vehicle. 

-2  Minimize  the  sum  of  the  magnitudes  of 
the  first  and  next  maneuvers  (based  on 
a coelliptic  parting  velocity)  by  varying 
At  , the  target's  update  time. 

s . = V 
opt 

1 Minimize  the  magnitude  of  the  first  ma- 
neuver by  varying  At , the  time  between 
the  next  maneuver  and  the  TPI  time. 

2 Minimize  the  sum  of  the  magnitude  of 
the  first  and  next  maneuvers  (based  on 
a coelliptic  parting  velocity)  by  varying 
At , the  time  between  the  next  maneuver 

s_  and  the  TPI  time. 

This  minimization  is  accomplished  by  driving  the  slope  (Av  / independent  variable) 
to  zero  using  a Newton  Raphson  iteration  scheme. 


1.2.3  Maneuver  Options  in  Integrated  Generation 
of  Maneuver  Segment 


The  integrated  generation  of  a maneuver  segment  involves  an  iterative  solu- 
tion to  determine  a maneuver  sequence  which  cannot  be  sequentially  solved  for  its 
maneuver  segment  components.  The  maneuver  is  computed  by  guessing  its  magni- 
tude, assigning  a direction  and  plane  through  selection  of  the  direction  switch 
Sdirect  ’ uPdating  the  primary  vehicle' s state  vector  after  selecting  switch  s 

up  atep 
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9. 8. 1.1  Rendezvous  Targeting  (continued) 


and  then- calling  additional  maneuver  segments  until  reaching  the  point  at  which 
the  terminal  constraint  is  to  be  attained.  The  maneuver  is  then  iteratively  de- 
termined by  satisfying  the  terminal  constraint.  The  number  of  additional  maneu- 
ver segments  and  the  nature  of  the  terminal  constraint  are  controlled  by  the  ter- 
minal constraint  switch  s, 

term 


2,  -3,  The  terminal  constraint  is  a phasing 

" " constraint  and  it  occurs  at  the  I s 

| term 

maneuver  point  from  the  start  of  the 
maneuver  segment . 


Sterm  < 


2,3..  The  terminal  constraint  is  a height 
. . <10 

constraint  and  it  occurs  at  the  s 

term 

maneuver  point  from  the  start  of  the 
maneuver  segment. 


(10<s).erm  Both  a height  and  phasing  constraint 

< 100  ) occur  at  the  same  maneuver  point. 

The  first  digit  n,  of  s,  repre- 
1 term  ^ 

sents  a phasing  constraint  that  occurs 
at  the  n ^ maneuver  point  from  the 
start  of  the  phasing  maneuver  segment. 
The  last  digit  n^  of  sterm  represents 
a height  constraint  that  occurs  at  the 
n2  maneuver  point  from  the  start  of 
the  height  maneuver  segment. 


1.2.4  Summary  of  the  Maneuver  Constraints 

The  maneuver  constraints  can  be  divided  into  the  following  catagories  (see 
Figure  3). 

Primary  vehicle  update  constraints 
Target  vehicle  update  constraints 
Initial  velocity  constraints 
Offset  constraints 
Terminal  constraints 
Traverse  constraints 
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9. 8. 1.1  Rendezvous  Targeting  (continued ). 


Table  1 contains  a detailed  listing  of  the  constraints.  The  three  constraints  (four 
in  the  case  of  noncoplanar  traverses)  which  govern  a maneuver  segment  cannot  be 
chosen  arbitrarily  from  this  .list.  One  of  the  justifications  for  presenting  the  three 
methods  of  generating  a maneuver  segment  was  to  allow  the  constructor  of  the 
rendezvous  sequence  to  easily  choose  compatible  sets  of  constraints. 


9. 8. 1.1  Rendezvous  Targeting  (continued) 


TABLE  1 

DETAILED  LISTING  OF  CONSTRAINTS 
(Sheet  1 of  2) 

Primary  and  Target  Vehicle  Update  Constraints 
Delta  time 
Initial  and  final  time 
Central  angle 
Number  of  revolutions 
Terminal  position  vector 

Initial  Velocity  Constraints 
Plane 

Parallel  to  target  orbit 
Parallel  to  primary  orbit 

Direction 

Horizontal 

Along  velocity  vector 
Magnitude 

Circular 
Coelliptic 
Altitude  change 
Specified 

Offset  Constraints 
Range 
Altitude 
Elevation  angle 

Terminal  Constraints 
Height 
Phase 
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9. 8. 1.1  Rendezvous  Targeting  (continued) 


TABLE  1 

DETAILED  LISTING  OF  CONSTRAINTS 
(Sheet  2 of  2 ) 


Traverse  Constraints 
Minimum  Fuel 

One  maneuver  optimization 
Two  maneuver  optimization 
Apogee/Perigee  designation 
Horizontal  maneuver 
Tangential  maneuver 
Lambert  (time) 


9.8-15 


9. 8. 1.1  Rendezvous  Targeting  (continued') 


NOMENCLATURE 


a . 

l 


cl* c2* c3 


A h 
Ar 


A r 


proj 


Semi-major  axis  of  a conic 
Alarm  code  i 

Failure  in  fuel  optimization  loop 

Failure  in  height  loop 

Failure  in  phasing  loop 

Failure  in  obtaining  Lambert  solution  in 
General  Maneuver  Routine 

Failure  to  find  perigee/apogee  in  Search  Routine 

Failure  to  find  time  corresponding  to  elevation 
angle  in  Search  Routine 

Failure  to  find  desired  position  vector  in 
Desired  Position  Routine 

Failure  to  update  through  0 in  Update  Routine 

Iteration  counter 

Height  iteration  counter 

Phase  iteration  counter 

Intermediate  variables 

Delta  altitude 

Delta  range  along  orbit  (determines  update  time 
= Ar / v TF ) 

Delta  projected  position 
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9. 8. 1.1  Rendezvous  Targeting  (continued) 


At 

Av 


A — LOS 


A-LV 


Av 


Ax 


-N 


m 

M 


n 

n 


r 


Delta  time 
Maneuver  velocity 

Maneuver  in  line-of-sight  coordinates 

Maneuver  in  local  vertical  coordinates 

Av  used  during  height  maneuver 

Av  used  during  phasing  maneuver 

Delta  velocity  used  in  fuel  minimization  loop 

Delta  independent  variable 

Error 

Eccentricity 
Height  error 
Phasing  error 

Elevation  angle  (defined  in  Figure  2 ) 

Unit  vector 

Unit  normal  to  the  plane  used  in  powered  flight 
guidance 

Number  of  the  maneuver 

Maximum  number  of  maneuvers  in  rendezvous 
sequence  currently  being  computed 

Estimated  vehicle  mass 

Rotational  matrix 

Vector  normal  to  the  orbital  plane 

Number  of  revolutions 
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9. 8. 1.1  Rendezvous ’'Targeting  (continued^ 


n 

rev 


Number  of  complete  revolutions  in  multi- 
revolution transfer 

Partial  used  in  Newton  Raphson 
iteration 


r 

r 

-D 

-lc 

s astro 

s coplan 

s direct 
s 

eng 

s 

exit 

s fail 
s 

man 

S opt 

s outp 
s 

pert 

S phase 
s 

proj 
s rdes 
s soln 
s search 
S term 
s update 


Distance  ratio 
Position  vector 

Desired  position  vector 

Target  vector  used  in  powered  flight  guidance 

Astronaut  overwrite  switch 

Coplanar  switch 

Maneuver  direction  switch 

Engine  select  switch 

Program  exit  switch 

Failure  switch 

Maneuver  switch 

Maneuver  optimizing  switch 

Out-of-plane  switch 

Perturbation  switch 

Phase  match  switch 
Projection  switch 
Desired  position  switch 
Solution  switch 

Search  switch 

Terminal  constraint  switch 

Update  switch 
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9.8.1.  Rendezvous  Targeting  (continued) 


■> 


y p > yP. 

yT 

Of 

p 


el 
€ 2 
€ 3 
f 4 


c5 
e 6 
€7 

f8 

y 

e 

0 

p 


Time 

Final  time 
Velocity  vector 

Vertical  component  of  velocity 
Circular  velocity 

Independent  variable  in  Iteration  Routine 
Out-of-plane  parameters  (see  Figure  6a) 


Radial  component  of  velocity  divided  by  v^ 

Horizontal  component  of  velocity,  divided 

by  vc 

Tolerance  on  time  in  fuel  optimizing  loop 

Tolerance  on  height  in  height  loop 

Tolerance  on  central  angle  in  phasing  loop 

Tolerance  on  transfer  angle's  proximity  to 
180  degrees  in  General  Maneuver  Routine 

Tolerance  on  central  angle  in  Search  Routine 

Tolerance  on  elevation  angle  in  Search  Routine 

Tolerance  on  central  angle  in  Desired  Position  Routine 

Tolerance  on  central  angle  is  Update  Routine 

Flight  path  angle 


Gravitational  constant 
Central  angle 
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Perigee  angle 


9. 8. 1.1.  Rendezvous  Targeting  (continued) 


Subscripts 


F 

i 

I 

LOS 

LV 

N 

0 

P 

s 

T 

TA 


Final 

Number  of  the  maneuver 
Initial 

Line-of-sight 
Local  vertical 
New 
Old 

Primary 

Stored 

Target 

Target  for  primary  vehicle 
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9. 8. 1.1  Rendezvous  Targeting  (continued) 


2.  FUNCTIONAL  FLOW  DIAGRAMS 

The  rendezvous  targeting  program  consists  of  two  major  parts  — a generalized 
maneuver  subroutine  which  basically  computes  a maneuver  and  updates  the  state 
vectors  of  both  vehicles  to  the  time  of  the  next  maneuver  and  a main  program  which 
sequentially  calls  the  subroutine  to  assemble  a rendezvous  sequence.  These  pro 
grams  call  a number  of  subroutines  which  are  briefly  described  below  and  in  de- 


tail  in  Section  5. 

Search 

To  update  the  state  vectors  to  either  a 
specified  apsidal  crossing,  a time,  or 
an  elevation  angle. 

Phase 

To  phase  match  the  target  vehicle's 

Match 

state  vector  to  the  primary  vehicle' s 
position  vector. 

Desired 

To  compute  a desired  position  vector  to 

Position 

be  used  in  a phasing  constraint. 

Update 

To  update  a state  vector  through  a speci- 
fied interval. 

Coelliptic  - 
Maneuver 

To  compute  a coelliptic  velocity  vector. 

Iteration 

To  determine  a new  estimate  of  the  in- 
dependent variable  in  a Newton  Raphson 
iteration  scheme. 

The  functional  flow  diagram  for  the  main  program  is  shown  in  Figure  4.  The 
main  function  of  this  program  is  to  sequentially  call  the  General  Maneuver  Routine 
to  compute  each  maneuver  segment  for  maneuvers  numbered  from  i to  i-max- 
There  are  three  major  options  that  can  be  exercised  prior  to  the  calculation  of  the 
first  maneuver  segment: 

(1)  A search  for  the  time  of  the  first  maneuver. 

This  time  can  be  specified  by: 

(a)  An  elevation  angle,  which  is  to  be 
attained  at  the  maneuver  time. 
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9. 8. 1.1.  Rendezvous  Targeting  (continued) 


ENTER 


Figure  4a.  Main  Program  - Functional  Flow  Diagram 
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9. 8. 1.1  Rendezvous  Targeting  (continued) 


Figure  4b.  Main  Program  - Function  Flow  Diagram 


9. 8. 1.1  Rendezvous  Targeting  (continued) 

(b)  Whether  the  next  maneuver  should  occur  at 
the  next  apsidal  crossing,  the  next  perigee 
crossing  or  the  nth  apsidal  crossing. 

(2)  A phase  matching  of  the  state  vector. 

(3)  A rotation  of  the  primary  vehicle' s state  vector 
into  the  plane  of  the  target  vehicle. 

There  are  three  separate  iterative  loops  built  around  the  call  to  the  general 
maneuver  routine.  One  loop  serves  to  minimize  the  fuel  used  during  a maneuver 
segment  with  the  options  determined  by  the  optimizing  switch. 

The  other  two  iterative  loops  involve  maneuver  segments  which  contain  con- 
straints that  do  not  allow  the  explicit  calculation  of  the  maneuver.  These  con- 
straints are  height  and  phasing  constraints  imposed  at  the  end  of  a maneuver  seg- 
ment and  controlled  with  the  terminal  switch.  The  iterative  loop  will  involve 
several  maneuver  segments  if  sufficient  constraints  are  not  imposed  to  solve  each 
segment  uniquely. 

The  functional  flow  diagram  for  the  general  maneuver  subroutine  is  shown 
in  Figure  5.  This  routine  generates  a maneuver  in  one  of  three  ways: 

(1)  As  an  explicit  function  of  the  initial  state  vector. 

(2)  As  a Lambert  maneuver  following  an  update  of  the 
passive  vehicle  to  establish  the  target  vector. 

(3)  As  a horizontal,  tangential  or  perigee/apogee  ma- 
neuver following  an  update  of  the  passive  vehicle 
to  establish  the  target  vector. 

Following  an  update  of  both  vehicle1  s state  vectors  to  the  time  of  the  next  maneu- 
ver, the  Av  used  or  the  terminal  height/phase  errors  are  calculated  as  required. 
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9. 8. 1.1  Rendezvous  Targeting  (continued) 


ENTER 


Figure  5.  General  Maneuver  Routine  - Functional  Flow  Diagram 
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9. 8.1.1  Rendezvous  Targeting  (continued) 


3.  INPUT  AND  OUTPUT  VARIABLES 

The  inputs  to  the  orbiter  rendezvous  targeting  program  can  be  divided  into 
five  catagories. 

Pre-Maneuver  Switches 

Upon  selecting  a maneuver  from  the  rendezvous  sequence,  these  switches 
(specified  for  each  maneuver)  serve  in  determining  the  state  vectors  at  the  maneu- 
ver point,  the  out-of-plane  parameters  and  the  calculation  of  a desired  position 
vector.  These  inputs  can  also  be  used  in  determining  the  time  of  a specified  apsidal 
crossing  or  the  time  at  which  a specified  elevation  angle  is  to  be  attained. 


’coplan 


’exit 


’outp 


’pert 


Coplanar  switch 
Bypass 

Rotate  primary  state  vector  into  plane 
of  target  vehicle's  orbit 

Exit  switch 

Bypass 

Exit  from  routine 
Out-of-plane  switch 
Bypass 

Compute  out-of-plane  parameters 
Compute  out-of-plane  parameters  and 
modify  maneuver  by  -y  p 

Perturbation  switch 
Do  conic  state  vector  updates 
Include  oblateness  based  on  Jj 
Other  perturbations  as  required 


=phase 


-2 


Phase  match  switch 
Bypass 

Phase  match  state  vectors  (target  leading 
primary) 

Phase  match  state  vectors  based  on  target 
leading  primary  by  more  than  360° 

Phase  match  state  vectors  (primary 
leading  target) 

Phase  match  state  vectors  based  on  primary 
leading  target  by  more  than  360° 
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9. 8.1.1  Rendezvous  Targeting  (continued) 


srdes 


Desired  position  switch 

0 Bypass 

1 Compute  desired  position  vector 
Search  switch 


ssearch 


-4  Compute  elevation  angle 
-3  Search  for  elevation  angle 
-2  Update  to  time  t- 
-1  Search  for  next  perigee  crossing 
0 Bypass 

n Search  for  the  nth  apsidal  crossing 
(n>0) 


Maneuver  Switches 

These  switches  (specified  for  each  maneuver)  set  the  constraints  employed 
in  determining  the  maneuver  segments. 


Direction  switch 


-2 


direct 


Av  in  direction  of  primary's  velocity 
vector,  parallel  to  primary's  orbital 
plane 

Av  in  horizontal  direction,  parallel 
to  primary  's  orbital  plane 
Bypass 

Av  in  horizontal  direction,  parallel  to 
target's  orbital  plane 
Av  in  direction  of  primary's  velocity 
vector,  parallel  to  target's  orbital  plane 


Maneuver  switch 


s 

man 


r 1 Av  is  specified 

2 Av  is  based  on  coelliptic  velocity 

3 Av  is  based  on  circular  velocity 

4 Av  is  based  on  altitude  change 

.12  Lambert  maneuver  using  target  vector 

obtained  by  updating  the  primary  vehicle's 
coelliptic  state  at  TPI 

13  Lambert  maneuver  using  primary  vehicle's 
TPI  position  as  a target  vector 

14  Lambert  maneuver  to  offset  target  vector5'" 

21  Horizontal  maneuver  to  offset  target  vector* 


* 


Obtained  by  updating  target  state  and  offsetting 


( A r , Ah). 


9. 8. 1.1  Rendezvous  Targeting  (continued) 


22 


man 


23 


opt 


s 


sohn 


’term  ~ / 


0 

n 


r 


3 update  \ 


0 

1 

2 

3 

4 

5 


Parameter  Values 


Maneuver  switch  (cont. ) 

Tangential  maneuver  to  offset  target 
point* 

Perigee/apogee  insertion  at  offset  target 
point* 

Maneuver  optimizing  switch 
Bypass 

Minimize  Av^ 

Minimize  Av.  + Av.  , . 

l l + l 

Multi-revolution  solution  switch 

Solution  with  smallest  initial  flight  path 
angle  (measured  from  local  vertical) 

Solution  with  largest  initial  flight  path  angle 

Terminal  constraint  switch 

(<  0 ) compute  phasing  error  and  back  up 
-(n  + 1)  maneuvers  for  start  of  phase  loop 
Bypass 

(0  < n<10)  Compute  height  error  and  back  up 
n - 1 maneuvers  for  start  of  height  loop 
(10  < n <100)  Phase  and  height  loop  terminate 
on  same  maneuver.  For  phase  loop  back  up 
x - 1 (where  x is  first  digit  of  n)  maneuvers 
for  start  of  phase  loop.  For  height  loop  back 
up  y - 1 (where  y is  last  digit  of  n)  maneuvers 
for  start  of  height  loop 

Update  switch 

Bypass 

Update  through  t p - t 

Update  through  At 

Update  through  n 

Update  through  0 

Update  to  be  colinear  with  r ^ 


The  parameter  values  (specified  for  each  maneuver)  are  values  for  the  con- 
strained parameters. 


Obtained  by  updating  target  state  and  offsetting  . ( Ar  , Ah) 
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9. 8. 1.1  Rendezvous  Targeting  ;( continued) 


A h Delta  altitude 

Ah„  Delta  altitude,  final 

F 

A r Delta  range  along  orbit 

At  Delta  time 

A v Maneuver  magnitude 

n Number  of  revolutions 

r 

n Number  of  complete  revolutions  in  multi- 

rev 

revolution  transfer 
t t-.  Final  time 

e^  Elevation  angle 

Post-Maneuver  Switches 

These  switches  (specified  for  each  maneuver)  determine  the  options  available 
ing  the  calculation  of  the  maneuver(s). 

Astronaut  overwrite  switch 

Bypass 

Overwrite  maneuver  in  local  vertical 
coordinates 

Overwrite  maneuver  in  line-of-sight 
coordinates 


astro 


Maneuver  Call  Variables 

The  maneuver  call  variables  have  to  be  specified  for  each  call  to  the  maneu 
ver  sequence. 


State  vector  of  the  primary  vehicle 

, Xt 

State  vector  of  the  target  vehicle 

i ■ 

Maneuver  number 

t 

Current  time 

t . 

l 

.th 

Time  of  the  i maneuver 

s 

eng 

Engine  select  switch 

m 

Estimated  vehicle  mass 

Depending  on  the  rendezvous  sequence,  there  may  also  be  some  switches  that  have 
to  be  modified  as  a function  of  the  maneuver  number. 

Excluding  the  maneuver  call  variables,  all  the  input  variables  can  be  set 
prior  to  the  flight. 

The  output  parameters  for  the  initial  maneuver  in  the  sequence  are  more 
complete  than  for  the  succeeding  maneuvers. 
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9. 8. 1.1  Rendezvous  Targeting  (continued) 


Output  Parameters  for  the  Initial  Maneuver 


A-LOS  i 
A^LVi 


-lc 


Maneuver  magnitude 

Maneuver  in  line  of  sight  coordinates 

Maneuver  in  local  vertical  coordinates 

Target  vector  used  in  Powered  Flight  Guidance 
Routine  (See  Ref.  1) 


In 


Unit  normal  to  plane  used  in  same  routine 


Other  parameters  such  as  delta  altitude,  phasing  angle,  elevation  angle  and  perigee 
altitude  can  be  computed  as  required. 

Output  Parameters  for  the  Other  Maneuvers  in  the  Sequence 
t Time  of  the  maneuver 

A v Maneuver  magnitude 


Illustration  of  Inputs 

Table  2 contains  a set  of  inputs  for  the  Orbiter  targeting  program  based  on  the 
five  maneuver  Skylab  rendezvous  configuration.  The  following  switches  and  para- 
meters are  not  used 

s , , s . . , s . , s . , s , , Ar , n 

astro  exit  opt  outp  soln  rev 

The  elevation  angle  e ^ and  perturbation  switch  spert  must  also  be  specified. 
These  inputs,  plus  those  in  Table  2,  are  all  set  prior  to  the  mission  so  they  will 
not  have  to  be  inserted  by  the  astronaut.  The  astronaut  will  have  to  modify  the 
following  quantities  upon  resetting  the  maneuver  number  as  well  as  inserting  the 
time  of  the  next  maneuver. 


i = 2:  s.  =0,  s,  =32 

1 terrcig  term^ 

1=  3:  supdateP3=1'  sman3=12,  At3=  tNSR-TPI 

i = 4:  s.  =0 

term^ 
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TABLE  2 

INPUT  VARIABLES  FOR  SKYLAB  RENDEZVOUS  CONFIGURATION 


Maneuver 


Input 

Variable 

1 

(NCI) 

2 

(NC2) 

3 

(NCC) 

4 

(NSR) 

5 

(TPI) 

s coplan 

1 

1 

0 

1 

0 

sdirect 

1 

1 

0 

0 

0 

s 

man 

1 

1 

1 

2 

14 

s phase 

1 

1 

0 

0 

0 

ssearch 

-2 

-2 

-2 

-2 

-3 

srdes 

1 

1 

0 

0 

0 

sterm 

0 

1 

0 

42 

0 

supdatep 

3 

3 

2 

1 

0 

supdate 

T 

2 

2 

2 

2 

4 

'max 

4 

4 

3 

4 

5 

tF 

tTpi 

tTPI 

tTPI 

*TPI 

0 

0 

0 

0 

0 

0 

0TPF-T 

At 

0 

0 

AtNSR  -NCC 

0 

0 

Ah 

0 

AhNCC 

AhTPI 

AhTPI 

0 

Ahp 

AhTPI 

AhTPI 

0 

0 

0 

Av 

AvNC1 

AvNC2 

Avncc 

0 

0 

nr 

nrNCl-NC2 

nrNC2  -NCC  0 

0 

0 
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DESCRIPTION  OF  EQUATIONS 


The  only  equations  contained  in  this  document  which  are  not  trivial  are  those 
involved  in  computing  the  traverse  between  two  specified  position  vectors.  The 
required  equations  can  be  derived  from  the  equation  of  the  conic  expressed  in  the 
form 

O r 

(1) 


where 


: rF  / rl 

= p2  / [l  + ec  cos  ( 0 + 0 p)  j 

e = 

c 

[ a2  8 2 + ( p2  - l)2  ] 1/2 

% = 

cos  1 j^(  jS2  - 1 ) / e c J (perige 

a 

^I-  ^l/rIvc 

2 2 2 ^2 
(vl/vc  ' 0/2  ) 

v = 

c 

( p/rj)l/2 

a and  (3  are  the  normalized  radial  and  horizontal  components  of  velocity; 
r j and  Vj  constitute  the  initial  state  vector. 

For  a maneuver  that  is'  constrained  to  be  in  a horizontal  direction,  Eq.  (1) 
can  be  solved  directly  for  fj 


P 


[ aM  o2  - 4c1c2^1^2  J / 2 


where 


c^  = (cos  0 - l/r ) / sin  0 

Cg  = ( 1 - cos  0 ) / sin  0 

As  there  has  to  be  both  a positive  and  negative  0 solution  to  this  equation 
(one  trajectory  in  each  rotational  direction),  the  sign  choice  is  resolved  in  favor 
of  plus  0. 

For  a maneuver  that  is  applied  along  the  velocity  vector,  the  flight  path  angle 
is  to  be  held  fixed.  Using  Eq.  (1) 

tan  = a / 0 = <Cj  0 2 + c^)  / jS  2 


Therefore 


P = \c2/  (tan^j  -ci>]  1//2 


For  a maneuver  which  is  to  result  in  a perigee  point  at  the  terminal  position 
vector,  Eq.  (1)  can  be  solved  for  the  following  conditions 
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0 + 6 = 0 : r = g2  / (1  + e ) 

P c 

0+0  =0  and  r =1:  l=02/(l  + e cos  0 ) 

P c 

Eliminating  ec  between  these  two  equations  results  in 

0 = [ r (cos  0-1)  / (cos  0 - r)  ] ^2 
In  all  three  of  these  cases,  a can  be  obtained  after  finding  0 
a = (o1^2  + c2)/)3 

As  the  above  equations  are  undefined  for  a 180  degree  transfer,  transfers  in 
the  near  vicinity  of  180  degrees  are  based  on 

0 = [ 2 r / (1  + r)  ] , 

the  Hohmann  horizontal  component  of  velocity.  For  the  180  degree  transfer,  the 
final  radial  component  of  velocity  equals  the  initial  radial  component  of  velocity. 
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5.  DETAILED  FLOW  DIAGRAMS 

Figures  6 and  7 contain  the  detailed  flow  diagrams  of  the  main  Orbiter  rendez- 
vous targeting  program  and  the  general  maneuver  routine,  respectively.  The  follow 
ing  six  routines  are  called  by  these  two  programs. 

Iteration  Routine 

This  routine  contains  a Newton  Raphson  iterative  driver  based  on  numerically 
computed  partials.  The  routine  computes  a new  estimate  of  the  dependent  variable 
x and  returns  the  old  values  of  the  error  e and  x.  If  the  iteration  counter  c 
exceeds  15,  a convergence  switch  scQnv  is  set  equal  to  one. 

Coelliptic  Maneuver  Routine 

This  routine  computes  a coelliptic  velocity  vector  vN  based  on  a target 
vehicle's  state  vector  and  a delta  altitude. 

Phase  Match 

This  routine  phase  matches  the  target  state  vector  to  the  primary  state  vec- 
tor. The  controlling  switch  (s  ) equals  two  if  the  leading  vehicle  leads  the 

phase 

other  vehicle  by  more  than  one  revolution:  otherwise  the  switch  equals  one.  If  the 
primary  vehicle  leads  to  target  vehicle,  the  switch  is  negative. 

Desired  Position  Routine 

The  routine  contains  an  iterative  search  to  determine  a position  vector  £D 
which  satisfies  the  elevation  angle  e and  delta  altitude  Ah  constraints  as  shown 
below.  (This  represents  the  TPI  geometry  used  in  Apollo  and  Skylab.) 


TPI  point  on  target  orbit 
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Update  Routine 

This  routine  updates  a state  vector  based  on  the  update  switch 


r 


s update  < 


1 

2 

3 

4 

5 


Search  Routine 


Updates  through  the  time  t p - t 
Updates  through  the  time  A t 
Updates  through  nr  revolutions 
Updates  through  the  angle  0 

Updates  to  where  the  orbit  intersects 
the  line  defined  by  r „ 


3 update 


This  routine  makes  the  following  computations  depending  on  the  setting  of 


the  search  switch  ssearch 


r 


= n Finds  the  time  of  the  nth  apsidal  crossing 
(>0)  and  updates  the  state  vector  to  that  time 

= -1  Finds  the  time  of  the  next  perigee  crossing 
and  updates  the  state  vector  to  that  time 


s 


search 


< 


-2  Updates  the  state  vector  through  the  time 


-3  Finds  the  time  associated  with  a specified 
elevation  angle  and  updates  the  state  vector 
to  that  time 


^ = -4  Computes  an  elevation  angle 

The  detailed  flow  charts  for  these  routines  are  shown  in  Figures  8 to  13. 


Each  input  and  output  variable  in  the  routine  and  subroutine  call  statements 
can  be  followed  by  a symbol  in  brackets.  This  symbol  identifies  the  notation  for 
the  corresponding  variable  in  the  detailed  description  and  flow  diagrams  of  the 
called  routine.  When  identical  notation  is  used,  the  bracketed  symbol  is  omitted. 
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Call  Search  Routine 


ilp*  x p * * y i 


Figure  6a.  Main  Program  - Detailed  Flow  Diagram 
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= Vs  \ + 0 

-<  optx  >— 


tc  = At. 
S l 


Call  Iteration  Routine 

Input:  c,  e,  tg  (x) , eQ  , tg0  (xQ  ) 

Output:  c,  tg  (x)  , e0,tS0(x0),sfan 


Figure  6b.  Main  Program  - Detailed  Flow  Diagram 
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Figure  6c.  Main  Program  - Detailed  Flow  Diagram 
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Figure  6d.  Main  Program  - Detailed  Flow  Diagram 
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9. 8. 1.1  Rendezvous  Targeting  (continued) 


UNIVERSAL  PROGRAM 

CONSTANTS  CONSTANTS  INPUT  VARIABLES 


(Figure  7d) 

Figure  7a.  General  Maneuver  Routine  - Detailed  Flow  Diagram 
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YT7 


updater 


0=0-  sign^(rpx£T)  • (£p*£p)jcos  [£p'IT/rprT] 


Call  Update  Routine 

Input:  £t[£].  vt(v],  t,  tp,  At,  nr>  0,  spgrt  , supdat6r 

Output:  £Tp[£F].  £TptZpl’  AtsfAt)>  tp 


ft 

At*  Atg  J-h 

=»  1 3 

Ar 

At'  =Ar/ vTp 

' nlan  / 

? 

At=  At+At' 

2 / \3 


Call  Update  Routine  


Input:  £TF[£]>  £TFf£]'  tpf*  1*  At'  fAtl’  spert  * Supdate  * 2 

Output:  £TF[lF],  ITf[-f]’  tF  


— TA=— TF  ‘ Ah  -TF^TF 


Call  Desired  Position  Routine 


Input:  £Tp[£].  vtf]v],  t^tj.tp,  eL,Ah,  spert 

Output:  £tf[£f].  1Tf[— f]  ’ -TaM 


Call  Coelliptic  Maneuver  Routine 

Input:  £tf 

Output:  vpF 

[£]. 

YTF[£l.  (rTF'rTA)[Ah] 

Call  Update  Routine 


Input:  £tA  [£].  vpF[vl.  tp[t],  At,  s pgrt  , Supdate=2 

Output:  £ta[~£f~]'  1Ta[— f]’  tF 


Figure  7b.  General  Maneuver  Routine  - Detailed  Flow  Diagram 
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Figure  7c.  General  Maneuver  Routine  - Detailed  Flow  Diagram 


9.8-42 
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Call  Update  Routine 

Input:  rp[£l*  £pf[£1*  *• 

Output:  rpN[rF],  vpN[vp_ 

tp.  At.  nr.  0,  spert  . supcjatep 
. At.  tN[tFJ 

Call  Update  Routine 


Input:  £p[£ !•  S pert’  supdate  ^ 

Output:  £TN[lF]-  £tn[-f]  * ^N^f] 


A £ - Vpp  — Vp 

Av  = Av  sign  (Av  • i) 


Call  Update  Routine 

Input:  £tn[£]« 

Output:  £rppf£p] 

£tn[-]*  - 
• £tf(-f] 

-pnI 

L-dJ 

j ’ 1*1'  s pert  ’ supdate  ^ 

Call  Coelliptic  Maneuver 


Input:  £tF^— .^TF^— ^rTF  rPN^ 

Output : £p  jsjp  £ Vj^j 


AvT  - |Av|  + |vpNF  vpN 


AvT  = j Av  j 
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Figure  7e.  General  Maneuver  Routine  - Detailed  Flow  Diagram 
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9. 8. 1.1  Rendezvous  Targeting  (continued) 


INPUT  VARIABLES 


Figure  8.  Iteration  Routine  - Detailed  Flow  Diagram 


UNIVERSAL 

CONSTANTS  INPUT  VARIABLES 


Figure  9.  Coelliptic  Maneuver  Routine  - Detailed  Flow  Diagram 
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Figure  10.  Phase  Match  Routine  - Detailed  Flow  Diagram 
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PROGRAM 

CONSTANTS 


INPUT  VARIABLES 


r,  v,  t,  tF,eL, 


Ah,  s 


Pert 


Call  Update  Routine 

Input:  r 

Output:  r 

v,  t. 

V 

, V 

S pert  ' supdate " 1 

.*f] 

e=7r/2-eL  - sin  1 [(r  p - A h)  cos  <e  ^ Vr  ] 

- cos"1  (r  • r F/r  rp)  sign  [(r  FX  r)  • (rx  v)  ]| 

I 


— D = — F ” 


Call  Iteration  Routine 

Input:  c,  e.  At  [ x ] , eQ  , A t q | 

Output:  c.  At  [ x]  , eQ  , A tQ  [xQ 

-X0  . 
l*Sf 

ail 

Set  Alarm 
Code  a - 


EXIT 


OUTPUT  VARIABLES 


-F’ -F’ — D 


Figure  11.  Desired  Position  Routine  - Detailed  Flow  Diagram 
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UNIVERSAL 

CONSTANTS 


PROGRAM 

CONSTANTS 


INPUT  VARIABLES 


Figure  12a.  Update  Routine  - Detailed  Flow  Diagram 
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Figure  12b.  Update  Routine  - Detailed  Flow  Diagram 
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UNIVERSAL  PROGRAM 

CONSTANTS  CONSTANTS  INPUT  VARIABLES 
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9. 8. 1.1  Rendezvous  Targeting  (continued) 


Figure  13b.  Search  Routine  - Detailed  Flow  Diagram 
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9. 8. 1.1  Rendezvous  Targeting  (continued) 


Figure  13c.  Search  Routine  - Detailed  Flow  Diagram 
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9. 8. 1.1  Rendezvous.- Targeting  ( continued) 


6.  SUPPLEMENTARY  INFORMATION 

The  Orbiter  rendezvous  targeting  program  proposed  herein  uses  the  basic 
targeting  philosophy  employed  in  Apollo  and  Skylab.  (See  Ref.  5 and  6.)  The 
Orbiter  program  represents,  to  some  degree,  a general  solution  to  the  rendezvous 
targeting  problem.  The  program  has  the  capability  of  solving  the  Apollo  and  Skylab 
rendezvous  configurations  as  well  as  many  other  configurations  that  can  be  deter- 
mined by  specifying  sets  of  secondary  constraints.  The  constraints  contained  in 
this  document  may  require  modification  as  experience  is  gained  in  generating  sets 
of  secondary  constraints  based  on  a variety  of  Orbiter  missions.  Reference  7 
contains  a more  detailed  discussion  of  the  nature  and  number  of  the  secondary  con- 
straints employed  in  the  maneuver  sequences. 

The  targeting  program  logic  has  been  verified  by  a computer  simulation  that 
disclosed  no  iterative  convergence  problems  for  the  range  of  trajectories  considered. 
Reference  8 contains  a simulation  of  a Skylab  five-maneuver  rendezvous  configura- 
tion using  the  Orbiter  targeting  program.  This  program  is  currently  being  inte- 
grated with  the  Orbiter  navigation  programs  to  verify  their  combined  effectiveness 
on  a number  of  Orbiter  missions. 

Some  of  the  maneuvers  described  in  this  document  were  based  on  conic  orbit 
assumptions  although  the  conic/precision  switch  was  set  to  indicate  that  oblateness 
should  be  considered.  One  example  is  the  computation  of  the  "circular  orbit"  ma- 
neuver based  on  the  conic  circular  velocity  vector.  This  calculation  can  be  modified 
to  provide  a maneuver  that  would  result  in  a minimum  altitude  change  orbit  in  an 
oblate  gravity  field.  (See  Ref.  9. ) 
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SPACE  SHUTTLE 


GN&C  SOFTWARE  EQUATION  SUBMITTAL 

Software  Equation  Section  Rendezvous  Braking  Submittal  No.  O 

Function:  Automatically  bring  Orbiter  within  desired  station-keeping 
boundries  relative  to  target  vehicle. 

Module  No.  0G3 Function  No.  __7 (MSC  036 90  Rev,  A) 

Submitted  by:  P.  . Kachmar Co.  MIT  No.  15 

Date : 23  November  1971 

NASA  Contract:  T.  Caro Organization  EG2 

Approved  by  Panel  III  KX.  Date  11  h*  hi 

Summary  Description:  The  program  includes  navigation,  targeting  and 

guidance  functions.  Line-of-sight  corrections,  braking  corrections 

and  filtering  of  rendezvous  measurement  sensor  data  to  improve  vehicle 
and  target  state  estimates  are  performed  in  a sequential  mariner.  Pro- 
vision is  made  to  either  use  Relative  State  Updating  routine  (Sec.  9.8.2) 
or  raw  data  and  to  use  (Apollo- type)  line-of-sight  braking  or  Lambert 
targeting  pending  the  result  of  on-going  studies. 

C omments : 


(Design  Status)  __ 
(Verification  Status) 
Panel  Comments:  
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1.  INTRODUCTION 

The  purpose  of  the  Rendezvous  Terminal  Phase  Braking  Program  is  to 
provide  the  means  of  automatically  bringing  the  primary  vehicle  (Orbiter)  within 
desired  station-keeping  boundaries  relative  to  the  target  vehicle  (or  satellite). 

To  accomplish  this  task,  the  program  of  necessity  contains  navigation,  targeting 
and  guidance  functions. 

The  program  is  initiated  subsequent  to  the  last  midcourse  maneuver  of 
the  rendezvous  targeting  sequence.  Line-of-sjght  corrections,  braking  correc- 
tions, and  filtering  of  rendezvous  measurement  sensor  data  to  improve  vehicle 
and  target  state  estimates  are  performed  in  a sequential  manner.  At  program 
initiation,  the  relative  range  is  on  the  order  of  three  to  five  miles. 

When  the  primary  vehicle  has  achieved  a position  (and  velocity)  relative 
to  the  target  which  places  it  within  the  desired  station-keeping  boundaries  so  that 
the  station-keeping  function  can  be  initiated  and  maintained,  the  program  is 
terminated. 
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9. 8. 1.2  Braking  (continued) 


NOMENCLATURE 


c . 

l 


Measurement  code  identifying 
at  t 


m 


ith 


measurement 


f ^ Thrust  of  the  engine  selected  for  the  maneuver; 

used  in  the  Powered  Flight  Guidance  Routines 


prev 


Previous  range  gate  passed;  subscript  used  in 
braking  (range)  gate  loop 


i 

- P 


Unit  vector  in  direction  of  relative  position  vec- 
tor, £ 


_ig  Unit  vector  which  defines  center  of  station-keeping 

boundary,  relative  to  target  vehicle 

k^  Constant  used  to  determine  the  range  at  which 

each  range  gate  search  starts  when  approaching 
that  particular  range  gate 

kg  Constant  used  to  determine  how  often  the  line- 

of-sight  targeting  loop  is  entered;  integer 
number  of  terminal  phase  program  cycles 

kg  Constant  value  of  range  rate  added  to  the  mini- 

mum range  rate  at  a given  range  to  insure 
primary  vehicle  intercept  of  target  vehicle 

Constant  used  to  determine  how  often  the  range-rate 
correction  targeting  loop  is  entered 

m Current  estimated  primary  vehicle  mass 

M R_g  Transformation  matrix  from  reference  coordinate 

frame  to  body  axes  coordinate  frame 
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M R-LOS 


M 


R-M 


M 

iV1R-SM 

M 

NB-B 

mnb-m 

M 

SM-NB 


n 


Transformation  matrix  from  reference  coordinate 
frame  (in  which  vehicle  states  are  expressed)  to 
LOS  coordinate  frame  axes 

Transformation  matrix  from  reference  coordinate 
frame  to  measurement  coordinate  frame 

Transformation  matrix  from  reference  coordinate 
frame  to  stable  member  coordinate  frame 

Transformation  matrix  from  navigation  base  frame 
to  body  axes 

Transformation  from  navigation  base  to  measurement 
coordinate  frame 

Transformation  matrix  from  stable  member  coordinate 
frame  to  navigation  base 

Number  of  discrete  braking  gates  in  the  range/ 
range  rate  correction  schedule 


qi 


I(tA> 


s 


B 


S eng 
S GM 


S LOS 


i th  measured  relative  parameter  at  t 
Primary  vehicle  position  vector 
Target  vehicle  position  vector 

Aimpoint  vector  used  in  Lambert  targeting  calcula- 
tions 

Switch  which  controls  braking  gate  targeting  cycle 
Engine  select  switch 

Switch  which  indicates  guidance  mode  to  be  used 
in  Powered  Flight  Guidance  Routine;  "2"-  two  axis 
thrusting;  "3'L  modified  Delta-v  mode;  "4"  - 
modified  Lambert  mode 

Switch  which  controls  line-of-sight  targeting  cycle 
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s LAM  Switch  used  to  select  type  of  targeting  scheme 

used  in  the  Terminal  Phase  Braking  Sequencing 
Program 

s Switch  used  to  select  method  used  to  process  the 

nav  ^ 

sensor  data 

s Switch  which  indicates  if  a velocity  correction  is 

to  be  made  or  not 


t 

c 


t . 


ig 


t 


m 


t 


s 


-P 


-T 


W 


I 


a 


2 

i 


P 


Current  time 
Maneuver  ignition  time 
Measurement  time 

Time  associated  with  primary  and  target  vehicle 
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frame 
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9. 8. 1.2  Braking  (continued) 
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Velocity  change  expressed  in  the  body  coordinate 
frame 


LIM  Magnitude  of  velocity  change  below  which  no  maneuver  will 

be  applied 
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Velocity  change  expressed  in  line-of-sight 
coordinate  frame 


Value  of  station-keeping  boundary  cone  angle 
Gravitational  constant  of  the  earth 
Relative  velocity  vector 
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Upper  bound  on  station-keeping  velocity 

Lower  bound  on  station-keeping  velocity 

Angular  velocity  lower  limit  below  which  no  line- 
of-sight  correction  is  made;  value  to  which  line- 
of-sight  angular  velocity  is  driven  if  a line-of- 
sight  correction  is  made 


LOS  Angular  velocity  vector  of  the  line-of-sight 

between  the  primary  and  target  vehicle 
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Magnitude  of  wLOg 


Magnitude  of  relative  position  vector,  P 

Range  rate  between  the  primary  and  target 
vehicles 

Relative  position  vector 
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9. $.1.2  Braking  (continued) 


6 . Minimum  range  rate  desired  between 
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‘ braking  gates  i and  i + 1 


i?off  (LV)  Offset  aimpoint  relative  to  target  point  expressed  in 
target  local  vertical  frame 
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Upper  bound  on  station-keeping  position 
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Azimuth  angle  of  line-of-sight  in  measure- 
ment frame 


Vector  expressed  in  measurement  coordinate  frame 


Prime  indicates  previous  values  of  a variable, 
e.  g.  prior  measurement  parameters,  prior 
measurement  time,  etc. 
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9. 8.1. 2 Braking  (continued) 


2.  FUNCTIONAL  FLOW  DIAGRAM 

The  functional  flow  diagram  for  the  Rendezvous  Terminal  Phase 
Braking  Program  is  shown  in  Figure  1.  The  program  is  initiated  after  the  last 
rendezvous  midcourse  correction  maneuver  of  the  rendezvous  targeting  sequence 
The  relative  range  between  the  primary  and  target  vehicle  at  this  point  is  on  the 
order  of  three  to  five  miles  and  closing. 

The  program  sequencing  begins  with  the  updating  of  the  estimated 
primary  and  target  vehicle  relative  state  parameters  with  the  appropriate  sensor 
data. 

These  relative  parameters  are  then  used  in  the  Terminal  Phase  Target 
ing  Program  where  the  necessary  calculations  are  performed  to  see  if  a line-of- 
sight  and/or  a braking  correction  is  required  to  maintain  the  desired  character  - 
istics  of  the  rendezvous  trajectory.  The  line-of-sight  corrections  (if  performed) 
maintain  the  intercept  by  nulling  out  line-of-sight  rates  which  exceed  a desired 
rate.  At  selected  ranges  between  the  primary  and  target  vehicles,  braking 
corrections  are  performed  to  reduce  the  closing  rate  to  that  specified  in  the  ter- 
minal range/range  rate  profile,  if  the  closing  rate  exceeds  the  desired  value. 
During  the  program  sequencing  a continuous  check  is  made  to  insure  that  the 
closing  rate  is  sufficiently  high  so  that  the  primary  vehicle  will  intercept  the 
target. 

If  either  a line-of-sight  correction  and/or  range-rate  correction  is 
necessary,  the  velocity  correction  is  applied  using  the  appropriate  guidance 
mode. 

The  program  sequencing  is  then  repeated.  The  program  is  terminated 
when  the  desired  relative  position  and  velocity  conditions  are  achieved  so  that  the 
station-keeping  mode  can  be  initiated  and  maintained. 


9.8-63 


9. 8. 1.2  Braking  (continued) 


ENTER 


Exit  to 


Station-Keeping  Mode 


Figure  1.  Rendezvous  Terminal  Phase  Braking  Program, 
Functional  Flow  Diagram 
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9. 8. 1.2  Braking  (continued 


3.  INPUT  AND  OUTPUT  VARIABLES 

The  Terminal  Phase  Braking  Program  consists  of  three  basic  functions 
navigation,  targeting  and  guidance.  The  following  is  a description  of  the  input 
and  output  variables  for  the  basic  sequencing  program,  the  navigation  program 
and  the  targeting  program.  The  Powered  Flight  Guidance  Program  is  described 
in  Ref.  3. 

3.  1 Terminal  Phase  Braking  Sequencing  Program 
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Input  Variables 

Estimated  primary  vehicle  state  vector  at  time  t 

Estimated  target  vehicle  state  vector  at  time  t 
Number  of  discrete  range  gate  corrections 

Range  values  of  the  n braking  gates 

Range  rates  desired  at  the  n braking  gates 

Switch  used  to  select  method  to  process  sensor  data 

Switch  used  to  select  type  of  targeting  scheme 
used  in  the  Terminal  Phase  Braking  Program 


Output  Variables 

r p , Vp  Primary  vehicle  state  vector  for  use  in  station- 

keeping phase 


r p , v p Target  vehicle  state  vector  for  use  in  station- 

keeping phase 

t Time  tag  of  above  state  vectors 

s 55 
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9. 8. 1.2  Braking  (continued) 


3.  2 Relative  State  Parameter  Updating  Routine 

This  routine  utilizes  raw  sensor  data  at  two  successive  times  to  deter- 
mine certain  required  relative  parameters.  There  are  no  input  variables  to 
this  routine.  The  output  variables  are  described  below 


Output  Variables 
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wLOs(*m^  Line-of-sight  angular  velocity  vector  between  the 
primary  and  target  vehicles  at  t 


w Log  ( * m ) Magnitude  of  the  line-of-sight  angular  velocity 
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Transformation  matrix  from  reference  to  line- 

of-sight  coordinates  at  t 
6 m 
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Transformation  matrix  from  reference  to  body 
coordinates  at  t 
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3.  3 Terminal  Phase  Targeting  Routine 
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Primary  vehicle  state  vector 

Target  vehicle  state  vector 

Relative  range  between  primary  and  target 
vehicle 
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Range  rate  between  primary  and  target 
vehicle 


9. 8. 1.2  Braking  (continued) 


_i  Unit  vector  in  direction  of  relative  range  vector 


^LQg  Angular  velocity  vector  of  the  line-of-sight  be- 

tween the  primary  and  target  vehicles 
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M R-B  Matrix  transformation  between  the  reference 

coordinate  frame  and  body  coordinates 

M R.LOS  Matrix  transformation  between  the  reference 

coordinate  frame  and  the  line-of-sight  coordinate 
frame 
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minal Phase  Braking  Program 
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9. 8. 1.2  Braking  (continued) 


s Switch  set  when  the  target  vector  must  be 

pro] 

projected  into  the  plane  defined  by  _i^ 


SGM 


Switch  which  indicates  guidance  mode  to  be  used 
in  the  Powered  Flight  Guidance  Sequencing  Program 
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9. 8. 1.2  Braking  (continued) 


4.  DESCRIPTION  OF  EQUATIONS 

4- 1 Terminal  Phase  Braking  Sequencing  Program 

The  Terminal  Phase  Braking  Sequencing  Program  (Figure  4),  which  is 
the  main  sequencing  program  for  the  terminal  phase,  is  initiated  after  the  last 
midcourse  correction  in  the  rendezvous  targeting  sequence. 

The  range/range  rate  terminal  braking  schedule  used  in  the  program 
is  determined  prior  to  the  initiation  of  the  program  and  consists  of  discrete  range 
gates  and  their  associated  desired  range  rates.  A minimum  range  rate  is  also 
specified  throughout  the  terminal  phase  to  insure  primary  vehicle  intercept  of 
the  target  vehicle.  An  example  of  such  a braking  schedule  is  shown  in  Figure  2. 

The  sequencing  begins  with  the  processing  of  rendezvous  sensor  data 
to  obtain  estimates  of  range,  range  rate,  line-of-sight  rates,  etc.  These 
estimates  are  derived  from  either  processing  the  sensor  data  in  the  Relative 
State  Updating  Routine  (which  is  also  used  throughout  the  rendezvous  sequence. 

Ref.  2)  or  from  the  raw  sensor  data  itself,  depending  on  the  input  value  of  the 
switch  s 

nav 

These  relative  parameter  estimates  are  then  used  in  the  Terminal 
Phase  Targeting  Routine  to  determine  if  a maneuver  (either  a braking  maneuver, 
line-of-sight  correction  or  a combination  of  both)  is  to  be  performed.  The  associ- 
ated maneuver  time  and  guidance  parameters  are  also  computed. 

If  a maneuver  is  to  be  performed,  the  Powered  Flight  Guidance 
Sequencing  Program  (similar  to  the  Servicer  Routine  in  Apollo)  is  entered  with 
the  appropriate  inputs  to  accomplish  the  maneuver. 

This  basic  sequencing  is  repeated  until  the  primary  vehicle  is  within 
desired  station-keeping  boundaries  relative  to  the  target  vehicle  (Figure  3). 

4.  2 Relative  State  Parameter  Updating  Routine 

The  Relative  State  Parameter  Updating  Routine  (Figure  5)  is  used  when 
it  is  desired  to  utilize  the  raw  sensor  data  to  obtain  the  necessary  relative  para- 
meters for  the  targeting  routine. 

The  rendezvous  sensors  are  read  at  t 1 along  with  the  associated  IMU 
gimbal  angles.  The  sensors  typically  will  consist  of  a ranging  device  and  a star 
tracker  which  measures  the  line-of-sight  angles  in  the  measurement  frame. 

Using  these  azimuth  and  elevation  angles,  the  line-of-sight  vector  in  reference 
coordinates  is  computed. 

fit  seconds  later  the  rendezvous  sensors  are  again  read  and  the 
line-of-sight  vector  again  calculated  in  the  reference  coordinate  system. 
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RANGE  RATE  (fps) 


9. 8. 1.2  Brakim 


RANGE  jnmi ) 


NOTE:  Change  of  scale  on  range  axis. 


Figure  2.  Typical  Range/Range  Rate  Schedule 
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9. 8. 1.2  Braking  (continued) 


Cone  angle  of  station-keeping  zone 

pxx’  pn  ' Upper  and  lower  values  of  station-keeping 
boundaries 

foff(LV)  - Relative  offset  vector  in  target  vehicle  local 
vertical,  used  to  target  Lambert  braking  cor- 
rections; primary  vehicle  will  intercept  this 
point  in  the  station-keeping  zone 


Figure  3.  Station-Keeping  Boundaries-Station-Keeping  Above 
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9. 8. 1.2  Braking  (continued) 


The  target  vehicle  state  vector  is  extrapolated  to  t using  the  Preci- 
sion State  Extrapolation  Routine  and  a primary  vehicle  state  vector  is  constructed 
using  the  target  vehicle  state  and  the  relative  parameters  just  computed. 

These  state  vectors  will  be  used  in  the  Powered  Flight  Guidance  Routines 
during  powered  flight  maneuvers  if  a maneuver  is  to  be  performed. 

4.  3 Terminal  Phase  Targeting  Routine 

The  Terminal  Phase  Targeting  Routine  (Figure  6)  computes  the  neces- 
sary maneuvers  to  maintain  the  primary  vehicle  on  an  intercept  with  the  target 
vehicle  while  keeping  the  range/range  rate  profile  within  the  desired  boundaries. 

Two  modes  of  operation  are  available.  The  first  mode  is  referred  to 
as  automatic  line-of-sight  control  braking  and  the  second  automatic  Lambert 
braking. 

When  s is  set  to  zero,  the  automatic  line-of-sight  control  braking 

LA  ivl 

mode  is  used.  If  the  line-of-sight  rate  as  determined  from  processing  the  sensor 
data  is  above  a set  limit  (typically  0.  1 m/sec),  the  line-of-sight  correction  neces- 
sary to  drive  the  line-of-sight  rate  to  some  level  is  computed  and  the  appropriate 
ignition  time,  engine  selection  and  guidance  mode  switches  are  set.  Since  these 
line-of-sight  corrections  are  made  frequently,  the  maneuver  magnitudes  are  small 
(several  feet/second  or  less)  and  hence  the  small  RCS  thrusters  are  used  to  effect 
the  maneuver.  The  maneuver  is  accomplished  by  using  two-axis  thrusting  normal 
to  the  line-of-sight. 

The  line-of-sight  correction  check  is  typically  made  every  two  cycles 
of  the  main  program.  (Line-of-sight  cycling  is  determined  by  kg) 

The  range/range  rate  checks,  to  insure  that  the  desired  terminal  profile 
is  being  followed,  are  made  after  the  line-of-sight  checks.  If  the  range  rate  at 
certain  pre-selected  ranges  exceeds  the  desired  range  rate  a braking  maneuver 
is  performed  to  reduce  the  closing  rate.  Continuous  checks  are  made  to  insure 
that  the  closing  rate  is  above  the  minimum  value  to  maintain  intercept.  If  it  is 
not,  then  the  closing  rate  is  increased. 

•If  a range-rate  correction  is  necessary,  the  appropriate  guidance 
switches  and  modes  are  set.  The  ignition  time  is  set  <5tg  seconds  from  the  present 
time  since  these  corrections  typically  involve  significant  maneuver  sizes,  and 
attitude  maneuvers  to  use  the  appropriate  engines  will  be  necessary. 

The  second  mode  of  operation,  the  automatic  Lambert  braking,  targets 
for  an  intercept  point  (either  the  target  vehicle  or  a point  offset  from  the  target 
vehicle  indicated  by  RQ^>  Figure  3)  at  each  pre-selected  braking  gate.  No 
independent  line-of-sight  corrections  are  made  in  this  mode  since  the  targeting 
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9. 8. 1.2  Braking  ( continued ) 


implicitly  corrects  line-of-sight  rate  to  insure  intercept, at  each  braking  gate 
correction. 

When  the  range  between  the  vehicles  reaches  ( 1 + k^)  times  the  pre- 
selected range  gate,  the  time  of  arrival  at  the  range  gate  is  computed.  The  cal- 
culation assumes  the  present  range-rate  remains  constant  until  the  range  gate 
is  reached.  The  primary  and  target  vehicle  state  vectors  are  then  advanced  to 
this  ignition  time. 

The  time  of  arrival  at  the  intercept  point  is  redefined  by  the  equation 

(Range  at  ignition) 

t = (Desired  range  rate  at 
® this  range  gate  ) 

This  t ^ is  then  used  to  calculate  a new  target  vector  for  use  in  the  Lambert 
routine  to  determine  the  necessary  velocity  correction. 

By  redefining  the  intercept  point  in  this  manner,  the  Lambert  solution 
forces  a reduction  in  range  rate  to  the  desired  range  rate,  insuring  intercept  in 
a length  of  time  equivalent  to  the  time  it  would  take  to  travel  the  present  range 
at  the  constant  desired  range  rate.  The  line-of-sight  rate  is  automatically  cor- 
rected in  the  Lambert  solution  to  assure  intercept. 

The  new  target  vector,  time-of-arrival,  ignition  time  and  guidance 
mode  switches  are  then  used  in  the  Powered  Flight  Guidance  Routines  (Ref.  3) 
to  effect  the  maneuver. 
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9. 8. 1.2  Braking  (continued) 


5.  DETAILED  FLOW  DIAGRAMS 

This  section  contains  detailed  flow  diagrams  of  the  Terminal  Phase 
Braking  Sequencing  Program,  the  Relative  State  Parameter  Updating  Routine, 
and  the  Terminal  Phase  Targeting  Routine. 

Each  input  and  output  variable  in  the  routine  and  subroutine  call  stat- 
ments  can  be  followed  by  a symbol  in  brackets.  This  symbol  identifies  the  nota- 
tion for  the  corresponding  variable  in  the  detailed  description  and  flow  diagrams 
of  the  called  routine.  When  identical  notation  is  used,  the  bracketed  symbol  is 
omitted. 
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9. 8. 1.2  Braking  (continued) 
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Figure  4a.  Terminal  Phase  Braking  Sequencing  Program  , 
Detailed  Flow  Diagram 
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(Figure  4c ) 


inal  Phase  Braking  Sequencing  Program, 
led  Flow  Diagram 
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9. 8. 1.2  Braking  (continued) 


Figure  4c.  Terminal  Phase  Braking  Sequencing  Program, 
Detailed  Flow  Diagram 
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9.8.1. 2 Braking  (continued) 
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Figure  5a.  Relative  State  Parameter  Updating  Routine, 
Detailed  Flow  Diagram 
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Figure  5b.  Relative  State  Parameter  Updating  Routine, 
Detailed  Flow  Diagram 


9.8-79 


9. 8. 1.2  Braking  (continued) 


Figure  5c.  Relative  State  Parameter  Updating  Routine, 
Detailed  Flow  Diagram 
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Figure  6a.  Terminal  Phase  Targeting  Routine, 
Detailed  Flow  Diagram 


9.8-81 


Figure  6b.  Terminal  Phase  Targeting  Routine, 
Detailed  Flow  Diagram 
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9. 8. 1.2  Braking  ( continued } 
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Figure  6d.  Terminal  Phase  Targeting  Routine, 
Detailed  Flow  Diagram 
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9. 8. 1.2  Braking  (continued) 


6.  SUPPLEMENTARY  INFORMATION 

The  design  of  the  Rendezvous  Terminal  Phase  Braking  Program  de- 
scribed in  the  preceeding  sections  has  been  based  on  the  work  reported  in  Refer- 
ence 1. 

The  design  is  such  as  to  incorporate  present  thinking  on  several 
desired  options.  The  first  is  the  method  of  processing  rendezvous  sensor  data 
either  with  the  Relative  State  Updating  Function  (with  the  appropriate  filter  modi- 
fications) or  using  the  raw  sensor  data  to  determine  the  necessary  relative  state 
parameters. 

The  second  option  is  to  use  either  the  automatic  line-of-sight  braking 
scheme  or  the  automatic  Lambert  braking  mode. 

These  options  are  indicated  in  the  flow  diagrams  by  the  use  of  appropriate 
switches  (for  example  SLAM)-  K is  conceivable  that  these  switches  may  not 
appear  in  the  final  equations  if  analysis  shows  that  one  option  is  clearly  the  best 
for  all  rendezvous  situations. 

Studies  are  presently  under  way  to  determine  the  following: 

1.  For  given  baseline  sensors,  what  is  the  best  way 
of  utilizing  this  sensor  data  to  obtain  the  neces- 
sary relative  state  parameters  ? 

2.  If  it  is  desired  to  filter  the  sensor  data,  what 
modification  to  the  Relative  State  Updating 
Function  is  necessary  to  obtain  the  desired 
filter  performance;  or  is  the  Station-keeping 
Updating  Function  satisfactory  in  this  phase  ? 

3.  Which  of  the  two  targeting  modes  is  best 
suited  for  a particular  sensor  processing 
scheme  or  is  a combination  of  the  two  modes 
the  best  ? 

4.  What  modification  of  the  Powered  Flight  Guidance 
Routine  and  targeting  routine  are  necessary  to 
obtain  the  desired  terminal  phase  profile  and 
performance  ? 
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9. 8. 1.2  Braking  (continued) 
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9.8.2  Relative  State  Updating 


1.  INTRODUCTION  AND  FUNCTIONAL  FLOW  DIAGRAM 


The  purposq  of  the  Relative  State  Updating  function  is  to 
provide  a means  of  automatically  and  autonomously  improving  on- 
board knowledge  of  the  relative  state  between  the  SSV  ( primary 
vehicle)  and  another  orbiting  vehicle  (target  vehicle).  This  know- 
ledge would  be  required  in  (a)  rendezvous  missions  as  inputs  to 
rendezvous  targeting  programs  to  compute  maneuvers  which  effect 
rendezvous  between  the  primary  and  target  vehicles  or  (b)  orbit 
navigation  modes  which  utilize  tracking  of  navigation  satellites  or 
satellites  ejected  from  the  primary  vehicle. 

Rendezvous  navigation  sensor  data,  consisting  of  measure- 
ments of  some  portion  of  the  relative  state,  are  accepted  at  discrete 
"measurement  incorporation  times".  Relative  state  updating  is  ac- 
complished at  each  of  these  times  by  sequentially  processing  the 
components  of  the  relative  state  measured  by  the  sensor.  A pre- 
cision extrapolation  routine  extrapolates  the  primary  and  target 
vehicle  state  vectors  and  the  filter  weighting  matrix  from  one 
"measurement  incorporation  time"  to  the  next.  A typical  measure- 
ment incorporation  sequence  is  thus: 

( a ) Extrapolate  primary  and  target  vehicle  state  vectors 
and  filter  weighting  matrix  to  measurement  incor- 
poration time  (tm) 

(b)  Accept  set  of  rendezvous  navigation  sensor  data 

taken  at  time  = t This  will  consist  of  k compon- 
ents of  the  relative  state  at  tm  given  by  ( i = 1, 

2,  ...,  k).  A measurement  code  ( c. ) is  associated 
with  each  to  identify  the  type  of  measurement 
taken. 
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9.8.2  Relative  State  Updating  (Con't) 


(c)  Process  in  the  Measurement  Incorporation 

Routine.  If  more  than  one  component  of  the  relative 
state  is  being  sensed,  process  C^,  Q^,  .... 
sequentially  in  the  Measurement  Incorporation 
Routine. 

(a)  thru  (c)  are  then  repeated  for  the  next  measurement  incorpora- 
tion time. 

A general  flow  diagram  of  this  function  is  presented  in  Fig. 

1.  The  inputs  required  by  this  function  are: 


1.  On-board  estimate  of  primary  vehicle  state  (Xp) 
with  time  tag. 

2.  On-board  estimate  of  target  vehicle  state  (x,p)  with 
time  tag. 

3.  Initial  filter  weighting  matrix  ( W)  (not  required  if 
computed  using  Automatic  Initialization  Routine). 

4.  A priori  sensor  measurement  variances. 

5.  Rendezvous  sensor  measurements. 


The  output  of  this  function  is  an  updated  n-dimensional  state  (x) 
which  minimizes  the  mean  squared  uncertainty  in  the  estimate  of  the 
relative  state.  This  output  is  available  after  each  measurement 
incorporation. 


The  operations  shown  in  Fig.  1,  with  the  exception  of  pre- 
cision extrapolation,  belong  in  this  function.  The  Precision  Extrapo- 
lation Routine  is  described  in  another  report.  The  bulk  of  the 
equations  involved  in  this  function  are  associated  with  the  Measurement 
Incorporation  Routine.  The  equations  involved  in  an  optional  Auto- 
matic Initialization  Routine  (initializes  the  filter  weighting  matrix) 
will  also  be  described.  The  equations  associated  with  reading  the 
rendezvous  navigation  sensor  will  be  described  in  a later  report. 
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9.8.2  Relative  State  Updating  (Con't) 


Figure  1 RELATIVE  STATE  UPDATING  FLOW  DIAGRAM 
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NOMENCLATURE 

b n -dimensional  measurement  geometry 

t>P0’  bpg  3 dimensional  measurement  geometry  vectors  as- 

sociated with  £p,  Vp 

b^  J -dimensional  measurement  geometry  vector  as- 

sociated with  7g 

m Measurement  code  identifying  i th  measurement  at 

t 

m 

FIRSTMEAS  Initially  set  to  "l"  and  reset  to  "0"  after  first 

entrance  into  Measurement  Incorporation  Routine 

FULLTRACK  "l"  if  angles  and  relative  range  measurements  have 
been  taken  prior  to  final  intercept  maneuver. 

"0"  if  angles  or  relative  range  measurements  only 
have  been  taken  prior  to  final  intercept  maneuver. 

MANEUVER  Initially  set  to  "0".  Set  to  "l"  at  completion  of 
maneuver 

MANNOTRK1  Assumed  "no  track"  time  immediately  prior  to 
maneuver 

MANNOTRK2  Assumed  "no  track"  time  immediately  following 
maneuver 

MANTM  Predicted  time  of  next  maneuver  ( either  from  pre- 

loaded  input  or  previous  targeting  routine) 

^NB-m  Transformation  matrix  from  navigation  base  axes  to 

rendezvous  sensor  axes.  is  fixed  according 

to  spacecraft  configuration. 
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Transformation  matrix  from  reference  coordinate  frame 

Mr  -SM  (in  which  initial  state  is  expressed  and  computations  are 

performed)  to  stable  member  axes . is  givenfrom 

specified  platform  alignment 

MSM-NB  Transformation  matrix  from  stable  member  axes 

to  navigation  base  axes  on  which  IMU  is  mounted. 
MsM-NB  is  determined  from  IMU  gimbal  angles 

NOTRACKTM  Maximum  break  in  tracking  threshold  - if  time  of 
"no  track"  period  exceeds  this,  W reinitialization 
is  inhibited  until  after  3 measurement  incorporation 
times 


POSTMANWR  Initially  set  to  "0".  If  set  to  "l",  forces  W rein- 
itialization prior  to  first  mark  after  maneuver. 


qest 

Qi 


-TP 


On-board  estimate  of  measured  parameter 
i th  measured  parameter  at  tm 
Magnitude  of  vector  rp 
Primary  vehicle  position  vector 
Target  vehicle  position  vector 
Relative  position  vector 


rTT  Position  vector  found  in  Automatic  Initialization  Routine 

~U  (A.I.R) 

RENDWFLAG  "0"  - W is  left  as  extrapolated  value  from  Precision 
Integration  routine  ( initially  set  to  "0") 

"1"  - W is  set  to  pre-loaded  value  given  by  Wp 
t Measurement  Incorporation  Time 


TBEFCOMP  Minimum  time  required  prior  to  a final  targeting 

computation  to  allow  requested  W reinitialization  to 
be  performed 
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TPIMAN 

Initially  set  to  "0".  Set  to  "l"  at  completion  of 
final  intercept  maneuver  (TPI) 

UNIT  (rp) 

Unit  vector  (rp/  rp) 

UPD 

= 1 find  state  of  primary  vehicle 
= 2 find  state  of  target  vehicle 

-P 

Primary  vehicle  velocity  vector 

-T 

Target  vehicle  velocity  vector 

-TP 

relative  velocity  vector 

VAR 

A priori  random  measurement  error  variance 

Velocity  vector  found  in  A.  I.  R. 

W 

n x n filter  weighting  matrix  associated  with  x 

WAIT3TM 

Initially  set  to  "0"  and  reset  to  "l"  in  order  to 
inhibit  W reinitialization  until  after  3 measurement 
inforporation  times 

WI 

Pre-loaded  value  of  initial  filter  weighting  matrix 

WF 

Pre-loaded  value  to  which  W is  reinitialized 

WMAXTM 

Maximum  threshold  value  - if  time  since  last  W 
reinitialization  exceeds  this,  a W reinitialization  is 
forced  to  occur  prior  to  the  first  mark  after  the 
next  maneuver 

WRTM 

Normal  threshold  value  - if  time  since  last  W rein- 
itialization exceeds  this,  a W reinitialization  is 
requested 
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X 


n-dimensional  state  vector 


x 


P “ 


X rp  “ 


— U 


6 dimensional  primary  vehicle  state  vector 


6 dimensional  target  vehicle  state  vector 


6 dimensional  state  vector  found  in  A.I.R. 


At 


m 


Time  increment  between  measurement  incorpora- 
tion times 


6x  n-dimensional  navigation  update  of  x 

Ep  A priori  standard  deviation  of  stable  member  mis- 

alignment 


-T 


A priori  standard  deviation  of  misalignment  between 
sensor  measurement  frame  and  navigation  base 


1 » 1q»  ha  A Priori  standard  deviation  of  sensor  bias  errors  in 
V p U 

range,  gimbal  angles  p and  8 (Fig.  2 ) 


!b 


j dimensional  sensor  bias  vector 


V ue 


A priori  standard  deviation  of  sensor  random  errors 
in  range,  8,  8 


P 


Gravitational  constant 
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9.8.2  Relative  State  Updating  (Con't) 


2 . DESCRIPTION  OF  EQUATIONS 


The  recursive  navigation  equations  presented  in  the  Measure- 
ment Incorporation  section  are  general  with  respect  to  the  dimension 
of  the  state  vector  to  be  updated.  These  equations  are  therefore 
applicable  to  any  one  of  the  following  navigated  state  vectors  which  is 
selected  for  the  shuttle  relative  state  updating  function.  (This  selec- 
tion will  ultimately  be  based  on  shuttle  G&  N computer  capacity, 
expected  target  vehicle  state  uncertainties,  and  the  error  character- 
istics of  shuttle  navigation  sensors.  ) 


Table  I 


Possible  Navigated  States 


Navigated  State  (x)  Parameters  Updated  State  dimensions  (n) 


A.  x = Xp  or  Xp 


B.  x 


' ip  or  ip  ' 

— B 


C.  x = 


ip  I 

Xrp  J 


/ ip\ 


D.  x = 


ip 


Ub/ 


primary  vehicle  state 
or  target  vehicle  state 


primary  or  target  vehicle 
state  plus  j components 
of  sensor  bias 


primary  and  target 
vehicle  states 


primary  and  target 
vehicle  states  plus 
j components  of 
sensor  bias 


6 


6+J 


12 


12 +j 
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For  any  of  these  navigated  state  vectors,  the  relative  state  does  not 
appear  directly,  but  is  updated  implicitly  as  a result  of  the  update  of 
either  or  both  vehicle  inertial  states.  Utilizing  the  state  vectors  (A 
or  B)  results  in  the  Apollo  rendezvous  navigation  filter,  whereas 
either  state  vector  (C  or  D)  results  in  an  optimum  rendezvous  navigation 
filter.  Specifying  the  dimension  (n)  of  the  navigated  state  vector 
automatically  specifies  the  dimension  of  the  measurement  geometry 
vector  b to  be  (n),  and  the  filter  weighting  matrix  W to  be  n x n. 


2.  1 Measurement  Incorporation  Routine 


As  discussed  above,  this  routine  is  entered  k (number  of 
measured  components  from  sensor)  times  at  each  measurement  in- 
corporation time  (t  ).  The  equations  presented  below  are  identical 
for  incorporation  of  each  of  these  components  with  the  exception  of 
equations  for  b,  and  VAR  which  depend  on  the  component  in- 

corporated. Equations  for  b,  QEgT,  and  VAR  are  given  for  typical 
relative  measurement  parameters  and  bias  estimation,  since  the 
precise  parameters  will  not  be  known  until  the  rendezvous  sensor  (s  ) 
are  selected.  The  assumed  sensor  coordinate  frame  geometry  is 
shown  in  Fig.  2.  ( Gimbal  limits  are  assumed  to  be  between  + 90°). 


The  precedure  for  computing  b,  QEST  and  VAR  is  as  follows: 


Compute  the  relative  state  ( xD  ) from- 

— n 


-R 


R 


TP 


-TP  / 


— T — p 


and 


P:  Primary  vehicle 
T:  Target  vehicle 


Figure  2 RENDEZVOUS  SENSOR  COORDINATE  FRAME  GEOMETRY 
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UR Tp  = UNIT  (RTp) 

From  the  measurement  code  (c.),  compute  b,  Q—Qrr 

1 — JlIjo  X 

and  VAR  appropriate  to  this  measurement. 


For  sensor  gimbal  angle  (/3 , 0 ) measurements,  make  the 
following  preliminary  computations: 


Compute  the  unit  vectors  of  the  sensor  coordinate 

frame  ux  , uy  , uz  from: 

— m *-m  ’ — m 


ux 

-m 


uy 

f-m 


MNB-m  MSM-NB  MR-SM 


\ T / 
\ "-m  / 


(lb)  Compute  sin  (e),  R xz  (Fig.  1)  from: 


S = - uR™^  • uy 
—TP  — • ’ m 

and 

Rxz  ■ “pt'F®7' 


Computation  of  b 


Depending  on  the  ultimate  selection  of  the  navigated  state 
( x of  Table  I),  the  vector  t)  will  take  on  the  following  definitions: 
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9.8.2  Relative  State  Updating  (cont’d) 


If: 


x = 


/ip 

/ *P 

X = 

Xrp 

. b = 

~-P 

w 

\ "V 

Compute  bpQ  and  bp3  from  the  appropriate  equations 
in  the  following  table  using  to  identify  the  type  of 
measurement 


Measurement 


-P0 


— P3 


Relative  Range 
Range  Rate 
Sensor  Angle  (8) 
Sensor  Angle  (0) 


U^rppX  (uRrppXVTp)/ ^ TP 

UNIT(uRTpXuym)/Rxz 

(uRTpXuym)xuRTp/Rxz 


0 

”U?_TP 

0 

0 


^3^)  Compute  b^ 

Ifq^P  is  included  in  the  navigated  state,  b will  be 
computed  based  on  the  selection  of  bias  parameters 
to  be  estimated.  The  following  are  equations  for 
some  possible  b 's,  with  c.  used  to  identify  the 
measurement  type 
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9.8.2  Relative  State  Updating  (cont'd) 


(a) 


Estimating  a single  bias  ( -yg)  in  measurement 
code  = j):  For  measurement  (code  = cn) 


b (scalar) 
7 


= j 


(b)  Estimating  bias  (xg)  in  m of  the  total  of  k 

measurements,  the  measurement  codes  of  the 
m measurements  being:  1,  2,  ....  m: 


b (m-vector)  = 


'i' 


*°/ 


/?' 


w 


/ ?\ 


w 


c.=l  ci=2  ...  c.=m 


b =0  for  c.  > m 

y - 1 

(c)  Estimating  three  angles  (ox.  cy  «z ) of  the 
stable  member  misalignment  about  x,  y,  z 
axes  of  stable  member,  i.  e. 


Measurement 

Relative  Range 
Range  Rate 

Sensor  Angle  (8)  RpX/Rxz  [^MR -SM^U -TP  X 

(uRxpxuym ) )^J 

Sensor  Angle  (0)  Mg  _gjyj  ( UNIT(uR^,pX  uym ) ) 


b ( 3 dimensional ) 


0 

0 
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9.8.2  Relative  State  Updating  (cont’d) 


Computation  of 

tLb  1 


Compute  estimate  of  bias 


( y ) in  measurement  form: 


A 

7 = 


is  initially  set  to  0 and  attains  a value  after 
measurement  incorporation  for  a state  (x)  which 
contains  will  be  the  corresponding  compon- 

ents of  6x  in  Eq.  (11)). 


Compute  QEgT  from  the  appropriate  equation  identi- 
fied by  the  measurement  code  ( c.. ): 


Measurement 

Relative  Range 
Range  Rate 

Sensor  Angle  (,8) 

Sensor  Angle  (9) 


Q 


EST 


R + a 
TP  7 


Xtp 


u5.tp  y 


1 rp  -pj  • UX 

Tan-^-^-P r“)+  * 

U— TP  ' u^m 
Sin"1  (s)  + y 


Computation  of  VAR 

Equations  for  VAR  can  not  be  anticipated  as  easily  as  was 
done  for  b and  QEST  since  it  is  so  strongly  a function  of  the  error 
model  for  the  particular  rendezvous  sensor  selected  for  the  final  con- 
figuration. The  measurement  variance  can  be  a constant  or  some 
function  of  relative  range,  range  rate,  etc  and  it  may  have  a minimum 
threshold.  Consequently,  equations  for  VAR  will  not  be  given  at  this 
time. 
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State  Vector  and  Filter  Update  at  Measurement  Incorporation  Time 

The  n x n filter  weighting  matrix  (W  ) is  available  from  one 
of  the  following  sources: 

At  the  first  measurement  incorporation: 

1.  Pre-loaded  values  based  on  mission  simulations 

2.  As  an  output  of  the  Automatic  Initialization  Routine 

Between  measurement  incorporations  at  a given  t : 

3.  From  the  computation  (below)  after  a measurement 
incorporation 

At  the  first  measurement  incorporation  of  new  t : 

* 

4.  From  the  Precision  Extrapolation  Routine 

5.  From  the  Automatic  Reinitialization  Routine 

Compute  n-dimensional  z vector  for  measurement 
( c. ) from: 

T 

z = W b 


i Wz 

z • z + VAR 


© 


Compute  n-dimensional  weighting  vector  u,  from; 


This  routine  provides  the  state  and  bias  portions  of  W when  time  in- 
variant biases  are  modeled.  For  estimation  of  biases  modeled  as  time 
variant,  appropriate  equations  in  the  Precision  Extrapolation  Routine 
will  be  formulated. 
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Compute  n -dimensional  navigation  update  of  x for 
measured  parameter  Q.  (code  = m)  from: 


6x  = to(Q.  - Qest  ) 


^9^  Update  x by: 

x = x + 6x 


© Update  W by: 


W = W-uz  /(1  + 


VAR 


z • z + VAR 


•) 


2 . 2 Automatic  Filter  Weighting  Matrix  (W)  Reinitialization 

If  reinitialization  of  the  filter  weighting  matrix  is  required 
( e.  g.  if  navigated  states  A or  B of  Table  I are  utilized),  this  opera- 
tion may  be  accomplished  automatically  by  the  Automatic  Reinitialization 
Routine.  This  routine  consists  almost  entirely  of  logic  statements 
so  that  there  is  no  real  need  to  present  a description  of  equations  here. 
Instead,  the  detailed  description  of  the  routine  will  be  provided  by  the 
detailed  flow  diagrams,  and  a brief  description  of  the  approach  will 
be  given  in  this  section. 

A conservative  approach  is  taken  in  that  W is  reinitialized 
to  pre-stored  values  more  often  than  actually  required  but  not  at  a 
time  which  would  violate  accepted  W matrix  reinitialization  ground 
rules.  The  only  exception  to  this  is  the  case  in  which  not  reinitializing 
will  most  probably  produce  a greater  performance  degradation  than  a 
reinitialization.  The  ground  rules  which  prohibit  reinitialization  are: 


9.8.2  Relative  State  Updating  (cont'd) 


1.  No  reinitialization  unless  a minimum  time  (TBEFCOMP) 
exists  prior  to  the  final  targeting  computation  for  a 
rendezvous  maneuver. 

2.  No  reinitialization  following  a "no  tracking"  interval 
greater  than  NO  TRACKTM  seconds,  until  after  3 
measurement  incorporation  times. 

The  only  exception  occurs  when  a maximum  time  has  passed  without 
a reinitialization  (WMAXTM)  because  of  ( 1 ) or  ( 2 ).  In  this  case  a 
reinitialization  is  forced  to  occur  immediately  following  a rendezvous 
maneuver  (representing  a "no  track"  interval)  instead  of  waiting  the 
required  3 measurement  incorporation  times  as  specified  by  (2). 


2 . 3 Automatic  Initialization  Routine 
2.3.1  Introduction 

This  routine  provides  a means  for  computing  an  initial  filter 
weighting  matrix  for  recursive  navigation  which  is  closely  related  to 
the  actual  errors  in  the  computed  relative  state.  Two  position  fixes 
are  required.  The  equations  described  relate  to  the  problem  of  find- 
ing the  inertial  state  of  one  vehicle  given  in  the  inertial  position  of 
the  other  and  the  relative  position  of  the  two. 


The  routine  might  be  used  if  the  inertial  state  of  the  primary 
vehicle  is  poorly  known.  That  is,  the  estimate  of  the  relative  state 
is  so  bad  that  the  (linear)  recursive  navigation  filter  does  not  con- 
verge. This  situation  might  arise,  for  instance,  when  (sensor) 
acquisition  does  not  occur  until  the  range  between  the  vehicles  is  of 
the  same  order  of  magnitude  as  the  relative  error  between  them. 
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2.  3.  2 Program  Input-Output 

The  required  inputs  to  the  routine  are  two  sets  of  sensor 
measurements  at  t^  and  tg,  and  two  inertial  positions  at  t^  and  t^. 

Also  required  are  various  assumed  values  for  instrument  performance 
to  be  used  in  forming  the  W matrix. 


rl 

01 

e 

1 

r2 

02 

e 

2 


sensor  measurements  at  t^ 


sensor  measurements  at  t ^ 


MR  -SM  | 

MSM-NB  ^ at  *1  and  t2  ^ f rotation  matrices 
MNB-m 


-T1 


-T2 


} 


CT0 

ae 


known  inertial  position  of  target  at  t^ 
known  inertial  position  of  target  at  1 2 

a priori  standard  deviation  of  sensor  random 
measurement  errors 


^r 

ne 


a priori  standard  deviation  of  bias  in  sensor 
measurement 


9.8-105 


9.8.2  Relative  State  Updating  (cont'd) 


Oi  rp 

PT 

yT 


a priori  standard  deviation  of  misalignment 
— T between  sensor  measurement  frame  and  navi- 
gation base 


a priori  standard  deviation  of  stable  member 
— P misalignment 


The  output  of  the  program  is  Xp  ( or  Xrp  ) at  t and  an  n x n 
W matrix  to  use  in  relative  state  updating. 


2.3.3  Description  of  Equations 

The  following  equations  are  in  two  parts,  computing  the 
state  of  the  unknown  vehicle  and  computing  the  related  covariance 
and  W matrix.  The  first  set  of  equations  uses  two  position  "fixes"  to 
solve  Lambert's  problem  for  the  velocity  connecting  the  positions. 

Calculation  of  the  State 

Let  r^,  6^  and  r^,  ft ^ ® 2 measurements  made  by 

the  sensor  at  the  times  t,  and  t_,  Find  the  cartesian  vector  r„  , 

1 2 —TPS  1 

in  the  sensor  frame  shown  in  Fig.  2. 

rTps  1 0 = rl  COS  61  sin  ^1 
rTPS  1,1  = ' rl  sin  ei 
rTPS  1 2 = rl  C0S  ®1  cos  ^1 
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9.8.2  Relative  State  Updating  (cont'd) 


Using  the  same  relations  define  r-ppg  2 
from  sensor  frame  to  reference  frame. 


Transform  the  vector  r^pg  ^ 


T T T 

-TP  1 = MR-SM'  MSM-NB  1 MNB-m  -TPS  1 


Similarly  define  the  vector  R,pp  2 from  ( r2*  8 2 * ^ePenc*ing  onthe 

value  of  logic  switch,  UPD,  extrapolate  either  the  primary  or  target 
vehicle  to  the  times  of  the  two  fixes  t^  and  t Using  these  two  inertial 
positions  the  two  relative  positions,  and  the  time  interval  At  = t2  -t, 
find  the  velocity  v^  2 v^a  the  Lambert  Routine.  The  six-dimensional 

state  vector  x^  2 at  is: 


-U  2 


-U  2 


-U  2 


From  two  position  measurements  it  is  impossible  to  estimate  any 
bias,  so  those  components,  if  included  in  the  state,  are  set  to  zero. 

Calculation  of  the  W- Matrix 

In  rendezvous  navigation  it  is  the  relative  state  which  is 
measured  and  used  to  update  either  (or  both)  of  the  inertial  vectors. 
Associated  with  the  relative  state  is  the  relative  covariance  matrix. 

As  an  example  the  W matrix  for  a 9 -dimensional  state  including  con- 
stant sensor  bias  is  computed. 

The  error  in  the  relative  state  is  due  to  errors  in  the  sensor 
measurements  r,  £,  and  9 and  to  errors  in  the  transformation  matrices, 

MR-SM*  MSM-NB’  MNB-m'  The  measured  quantities  rm.  0m.  and 

6 include  noise  a and  bias  ri. 
m — — 
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9.8.2  Relative  State  Updating  (cont'd) 


a s.  (ar,  Oq  ) 

H — ( -^Q  ^ 

Errors  in  the  transformation  matrices  are  due  to  stable  member 
misalignment  and  structural  deformation  between  the  sensor  and  the 
navigation  base.  These  errors  in  the  two  matrices  Mp_gjyj  and 

^NB-m  are  expressed  as  €p  and  These  pseudo-vectors  represent 
one  standard  deviation  small  rotations  about  three  othogonal  axes. 

From  the  values  of  a , rj  , Crp  and  e^ptwo  diagonal  9x9  matrices 
SIG  and  GAM  are  formed.  It  should  be  noted  that  rj2,  and  p20  ap- 
pear in  SIG  if  each  of  those  components  of  bias  is  to  be  estimated 
( as  is  done  here),  otherwise  they  appear  in  GAM. 

Combinations  of  several  3x3  partial  derivative  matrices 
make  up  a 9 x 9 matrix  relating  state  error  to  the  matrix  SIG.  Those 
component  matrices  will  now  be  computed. 

The  partial  derivative  matrix  of  relative  position  error  in 
the  sensor  frame  due  to  error  in  r,  |3  and  6,  DRDMg,  is  computed 
by  simply  taking  the  necessary  derivatives  of  the  geometric  relations: 


rk,0  = rk  cos  0ksin\ 
rk,  1 = - rk  sin  6k 
rk,2  = rk  cos  6k  cos  ^k 

Combined  with  transformation  matrices  the  partial  derivative  matrices 
allow  the  partial  derivative  matrix  of  relative  position  error  in  the 
inertial  frame  to  be  written: 


DRDM 


k 


= M 


T 

R-SM 


M, 


SM-NB  k 


M 


T 

NB-m 


DRDM„  , 
S k 


9.8-108 


9.8.2  Relative  State  Updating  (cont'd) 


The  dependence  of  the  velocity  deviations  6v^  2 on  two 
position  errors  must  be  computed.  The  two  matrices  DVDR0  and 

Li 

DVDR^  are  derivatives  of  Lambert's  solution  for  the  velocity  at  the 
second  point.  They  may  be  computed  from  values  of  semi-major 
axis^  1 /a,  eccentric  anomalies,  E^»  and  S and  C (Battin's  special 
transcendental  functions  ) found  in  the  Lambert  Routine. 

reciprocal  of  semi-maior  axis 
(%  _ -^2 )/  v|a  * (E  = eccentric  anomaly) 


Battin's  special  transcendental  functions 


a = 

x = 

y 

S (ax2)  \ 

C(ox2) 


Using  these  variables  and  the  following  definitions  proceed: 


A 


DC 

°Q 

Qd 


F 

H 


N 

li2l 

UNIT  ( rx ) 

UNIT  <r2) 

'I  2 - a x2  c 
(c  -3S)/(2ax2) 

(1  - ax2  S - 2C)/  ( 2 a x2  ) 

- sin  { sfo  x2  ) / (4  q \ a x2  ) 

(3  x S y Dc)/  (2C2)  - x3  Dg 

\fi“77~ I a 

y/  r!  - 1 
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9.8.2  Relative  State  Updating  (cont'd) 


G 

F H 

Y 

c 

F/  rx  - G/  2y 

A 

c 

-G/a 

<0 

VJ 

II 

<*l  (2\fy)  + 3 S X /( 2C) 

D 

Qd  + Qy  0 °Q 

II 

(5"' 

( ?1  + ?2  ] r2  / 2a 

v = 

( + r2  ) r1  / 2a 

0 2 

V^x 

( <>Tyn-  Qyq  )7ja  + Q fjj/D 

„ 2 
V2»x  = 

( (\|y-  Qyq  ) V2»  + Qy  r2  ) / D 

V - 

rl  _q  via  - * DqV^x2 

V2y  = 

r2  ~q  V2°  " 0 °Q  V2q'x2 

>< 

II 

- F ( Vx  0 / a + Vjy  / 2y ) 

V = 

- F ( V2n/  a + V2y/  2y  ) 

v2g  . 

Yc  V + Ac  V2  ° 

VjG 

Yc  Vi^  + AC  vf  Fy  ^1  / r22 

dvdr2  = 

A T A T 

G I + r2  VXF  + rx 

DVDR1  = 

„ A T A T 

FI  + r2  V2F  +rl  V2G 

( I is 

the  3 dimensional  identity  matrix ) 

Combined  with  DRDM^  and  DRDM2  the  above  matrices  yield 
the  9x9  partial  derivative  matrix  relating  the  state  to  the  matrix  oi 
sensor  random  and  bias  errors. 
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9.8.2  Relative  State  Updating  (cont’d) 


DVDM1  = DVDR1  DRDM1 

dvdm2  = dvdr2  drdm2 

DVDE  = DVDM1  + DVDM2 


DSDS  = 
(9x9) 


dvdm2 

dvdm2 

0 


0 

DVDM1 

0 


drdm2 

DVDE 

I 


A second  9x9  partial  matrix  relates  state  errors  to  un- 
estimated sensor  bias  and  the  two  misalignments.  The  additional 
needed  3x3  component  matrices  are  computed  now. 


The  matrix  DRDETg  relates  position  error  atthefirst  "fix' 
in  the  sensor  frame  to  misalignment  between  sensor  and  navigation 
base 


rTPS  k,  2_rTPS  k,  1 


DRDE 


ts  r 


-r 


TPS  k,  2 


TPS  k,  0 


rTPS  k,  1 ~rTPS  k,  0 0 


This  matrix  rotated  into  the  reference  frame  is: 


DRDE 


t r 


MR-SM  MSM-NB  1 MNB-m  DRDETS1 


In  the  same  way  DRDE^.  2 corap^ed. 
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9.8.2  Relative  State  Updating  (cont'd) 


The  matrices  relating  stable  member  misalignment  to  error 
in  position  in  the  reference  frame  DRDEp  is  computed  in  the  same 
way.  It  consists  of  a matrix  composed  of  elements  of  the  relative 
position  vector  in  the  reference  frame  rpp. 

Using  the  chain  rule  allows  the  computation  of  the  matrices 
relating  velocity  to  the  two  misalignments: 


DVDEt  = DVDR2  DRDEt  2+ DVDR1 DRDEp  x 
DVDEp  = DVDR2  DRDEp  2+  DVDR^ DRDEp l 

The  dependence  of  estimated  bias  in  r,  jS  and  8 on  the  two 
misalignments  is  given  by  the  following  two  matrices. 


DBDEp  = DRDMg^  DRDEpg 


DBDEp  DRDMg  1 MgM_NB ^ MR_gM  DRDEpg  ^ 


The  complete  9 x 9 partial  matrix  is  thus: 


DSDG 


DRDM2 

DRDEp  2 

DRDEp  2 

DVDE 

DVDEp 

DVDEp 

I 

DBDEp 

DBDEp 

The  covariance  matrix  of  errors  in  the  relative  state  in  the  reference 
frame  is: 
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9.8.2  Relative  State  Updating  (cont'd) 


6r 

I 6r  6v  6b 

6v 

L 

6b 

DSDS  SIG  DSDST  + DSDG  GAM  DSDGT 


The  W matrix  can  be  found  from  the  above  covariance  matrix  by 
forming  a diagonal  matrix  E£  consisting  of  the  square  roots  of  the 
diagonalized  covariance  matrix.  If  the  rows  of  the  matrix  RV  are 
eigenvectors  of  COV;  that  is  RV  is  defined  to  be: 


= RV  COV  RVT 


The  W matrix  is  then: 

W = RVT 

(Note;  The  above  indicates  symbolically  the  definition  of 
W but  the  actual  routine  to  compute  W may  or  may  not  use  the  above 
steps).  The  vector  state  ^r^,  the  time  t2  and  the  relative 

W matrix  are  returned  to  the  calling  program. 


'11 


E 


'22 


etc 


E 


'11 


E 


'22 


etc 
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9.8.2  Relative  State  Updating  (cont'd) 


3.  DETAILED  FLOW  DIAGRAMS 


This  section  contains  detailed  flow  diagrams  for  the  Auto- 
matic Initialization  Routine  and  Measurement  Incorporation  Routine 
of  the  Co -orbiting  Vehicle  Navigation  Module.  A nine  dimensional 
W -matrix  is  computed.  The  three  adjoined  elements  are  for  constant 
sensor  bias  in  r,  8.  and  9.  These  particular  biases  were  chosen  only 
as  an  example. 

Two  routines  used  are  not  yet  documented:  the  Lambert 
Routine  and  the  Eigenvalue  Routine. 
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9.8.2  Relative  State  Updating  (cont'd) 


ENTER 


Figure  3a  DETAILED  FLOW  DIAGRAM, MEASUREMENT  INCORPORATION  ROUTINE 
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9.8.2  Relative  State  Updating  (cont'd) 


yAIT3TM 
= 0 or  4 


~ WAIT3TM  = 
— H WAIT3TM  + 1 


WAIT3TM  = 0 


Maneuver  = 0 


Maneuver 
\ = 1 


''POST  MAN  WI 
V = 1 


TPIMAN  = 1 


RENDWFLAG=1 
WR  = wF 

POSTMANWR 


-TIMEWR 

WRTM 


Figure  3b  DETAILED  FLOW  DIAGRAM, MEASUREMENT  INCORPORATION 

ROUTINE 
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9.8.2  Relative  State  Updating  (cont'd) 


Figure  3c  DETAILED  FLOW  DIAGRAM. MEASUREMENT  INCORPORATION 

ROUTINE 
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Figure  3d  DETAILED  FLOW  DIAGRAM  .MEASUREMENT  INCORPORATION 

ROUTINE 


9.8-118 


9 *8* 2 Relative  State  Updating  (cont'd) 


Figure  3e  DETAILED  FLOW  DIAGRAM,MEASUREMENT INCORPORATION  ROUTINE 
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Cycle  to  ® 


Figure  3f  DETAILED  FLOW  DIAGRAM, MEASUREMENT  INCORPORATION 

ROUTINE 
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9.8.2  Relative  State  Updating  (cont'd) 


ENTER 


Figure  4a  DETAILED  FLOW  DIAGRAM.AUTOMATIC  INITIALIZATION  ROUTINE 
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Figure  4b  DETAILED  FLOW  DIAGRAM  .AUTOMATIC  INITIALIZATION  ROUTINE 
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9.8.2  Relative  State  Updating  (cont*d) 


Figure  4c  DETAILED  FLOW  DIAGRAM, AUTOMATIC  INITIALIZATION  ROUTINE 
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9.8.2  Relative  State  Updating  (cont'd) 


Figure  4d  DETAILED  FLOW  DIAGRAM, AUTOMATIC  INITIALIZATION  ROUTINE 
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9.8.2  Relative  State  Updating  (cont'd) 


I 


Qd 

= 

3xyS  Dc/  (2C?)  - x3  Dg 

F 

= 

\|W  y'/  a 

H 

= 

y/  r!  - 1 

G 

= 

F H 

Y 

c 

= 

F/  rx  - G/2y 

A 

c 

= 

-G/ a 

>> 

Of 

= 

a/  (2  Jy1)  + 3xS/  (2c) 

D 

= 

Qd  + Qy  o-  Dq 

= 

( rx  + r2  ) r2  / 2« 

v2« 

= 

( rx  + r2  ) rx  / 2 a 

„ 2 
V^x 

= 

( < ry  " Qy  Q ) VjQr  + Qy  rx ) / D 

V2ax2 

= 

( ( ry  - Qy  Q ) V2e  + Qy  ) / D 

vLy 

= 

rx  - Q a - a Dq  Vj  ox2 

v2y 

= 

r2  - QV2a  ' Q DQ  V2q'x2 

V 

= 

- F ( / a + Vxy/  2y) 

v2f 

= 

- F ( V2a/  a + V2y  (2y ) 

VXG 

= 

Yc v/ + Ac  \a  ~ F y ri/  r2 

V 


Figure  4e  DETAILED  FLOW  DIAGRAM, AUTOMATIC  INITIALIZATION  ROUTINE 
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9.8.2  Relative  State  Updating  (cont'd) 


I is  the  3D  identity  matrix 
0 is  the  3D  null  matrix 


Figure  41  DETAILED  FLOW  DIAGRAM, AUTOMATIC  INITIALIZATION  ROUTINE 
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9.8.2  Relative  State  Updating  (cont'd) 


A 


i 

DRDET  k = MR-SM  MSM- 

NB  k MNB-m  DRDETS  k 

-TP  SMk'  MSM-NB  k JV1NB-m  -TPS  k 


T 

M*  rn 


l 


r— 



0 

rTPSM  k,  2 

'rTPSM  k,  1 

DRDEp k= 

”rTPSM  k,  2 

0 

rTPSM  k,  0 

1 

rTPSM  k.  1 

_rTPSM  k,  0 

0 

i 

L- 

■ 

DRDEPk  = mr-sm  DRDEPk 


DVDEt  = DVDR2  DRDEt  2 + DVDR1  DRDET  l 
DVDEp  = DVDR2  DRDEp  2 + DVDR1  DRDEp  1 


DBDEt  = DRDMg^  DRDETS  1 


DBDEp  = DRDMs11MNB_m  MSM-NB  1 MR  -SMDRDETS  x 


Figure  4g  DETAILED  FLOW  DIAGRAM, AUTOMATIC  INITIALIZATION  ROUTINE 
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Figure  4h  DETAILED  FLOW  DIAGRAM, AUTOMATIC  INITIALIZATION  ROUTINE 
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9.8.2  Relative  State  Updating  (cont'd) 


4.  SUPPLEMENTARY  INFORMATION 

The  equations  presented  in  this  report  are  the  results  to  date 
oi  studies  performed  under  a G & C shuttle  task  to  develop  G&  N 
equations  i'or  automatic  rendezvous.  Two  fundamental  approaches  were 
taken  in  these  studies:  (1  ) automate  proven  Apollo  rendezvous  naviga- 
tion equations;  (2  ) develop  optimum  rendezvous  navigation  equations 
By  presenting  the  equations  in  the  general  form  shown,  they  are  made 
to  reflect  formulations  developed  using  both  approaches  (1)  and  (2). 
Analyses  performed  to  evaluate  the  filter  equations  are  reported  in  the 
references. 

To  complete  the  automation  of  the  Apollo  filter,  an  automatic 
mark  reject  routine  remains  to  be  formulated. 
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9.8.3  Rendezvous  Guidance  (same  as  9.7.3) 


9.8-129 


9 . 9 STATION  KEEPING  MISSION  PHASE 


Station  keeping  begins  with  the  targeting  for  braking  as  the  Shuttle 
approaches  the  target  vehicle  sometime  after  TPI.  This  phase  includes 
braking  targeting,  braking,  positioning  for  station  keeping,  automatic 
station  keeping,  repositioning  to  station  keep  at  a different  position 
relative  to  the  target  vehicle  and/or  in  preparation  for  docking. 
Automatic  station  keeping  here  means  the  preservation  of  a precise  ■ 
relative  position  with  the  target  vehicle  with  no  requirement  for  manual 
commands.  Automatic  station  keeping  may  occur  before  docking,  after 
docking,  and  on  missions  in  which  docking  does  not  occur.  This  phase 
ends  when  the  docking  maneuver  begins,  or  when  the  shuttle  is  separated 
from  the  target  vehicle  with  no  intention  of  preserving  a precise 
relative  position  with  it. 

The  software  functions  required  in  this  mission  phase  are  the 
following : 

1.  Estimate  relative  state  of  target  vehicle  based  on 
external  measurements. 

2.  Estimate  absolute  states  of  both  shuttle  and  target 
vehicle. 

3.  Compute  (target)  the  braking  AV(s)  required,  their 
direction,  and  the  time(s)  of  ignition. 

4.  Execute  braking  maneuver  by  commanding  engine (s)  on, 
providing  attitude  commands  during  braking,  and 
commanding  engine (s)  off. 

5.  Powered  flight  navigation. 

6.  Automatically  preserve  a relative  position  and  attitude 
with  the  target  vehicle  by  periodic  RCS  engine  on/off 
commands  with  a minimum-fuel  technique.  Spatial  and 
angular  requirements  and  allowable  variations  during 
automatic  station  keeping  are  TBD. 

7 . Provide  RCS  engine  commands  to  achieve  commanded 
attitude  during  AV  maneuvers  and  during  coast  periods 
(digital  autopilot) . 

Repositioning  for  docking  maneuver  initiation,  for  a separation  maneuver, 
or  for  station  keeping  at  a different  relative  position  is  assumed  to 
be  a manual  function  and  therefore  no  software  for  performing  these 


9.9-1 


maneuvers  automatically  is  required. 

A flow  of  software  functions  during  station  keeping  appears  in 
Figure  1.  Some  functions  overlap  with  other  mission  phases  and  only 
those  equations  not  provided  in  earlier  sections  are  discussed  here. 

9.9.1  Relative  State  Estimation  (TBD) 

9.9.2  Station  Keeping  Guidance  (TBD) 

9.9.3  Station  Keeping  Attitude  Control  (TBD) 


9.9-2 


Target 

Vehicle 


0) 
*0 
1—  3 
a J -*-> 

3 *r— 
4->  4-> 
U +-> 

*<  <c 


9.9-3 


Figure  1.  Flow  of  Software  Functions  During  Station  Keeping 
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DOCKING  AND  UNDOCKING 


The  two  distinct  events  are  described  as  one  phase  since  the 
events  are  essentially  reversals  of  one  another.  The  distinction  between 
the  docking  event  and  terminal  rendezvous  is  the  point  at  which  the  man- 
euver defined  by  the  docking  constraints  on  such  variables  as  range, 
range  rate,  attitude,  and  attitude  rate  is  initiated. 

The  mode  of  docking  is  still  open;  that  is,  it  has  not  been 
determined  whether  the  docking  will  be  performed  manually  or  automatically, 
with  a manual  backup  capability.  The  GN&C  software  functions  to  be  per- 
formed during  this  phase  are  based  on  an  automatic  docking  with  manual 
backup.  The  docking  SW  functions  are: 

a)  Specific  force  integration  updates  of  relative  states 
during  translational  burns.  This  function  will  maintain 
the  relative  state  between  the  orbiter  and  its  co-orbiting 
target  during  orbiter  bums. 

b)  Maintain  attitude-hold  about  a desired  orientation. 

c)  Compute  and  command  steered-attitude  RCS  AV  maneuvers  for 
docking. 

d)  Make  high-frequency  steering  estimates  between  guidance 
samples  for  docking. 

e)  Provide  three-axis  translation  control. 

The  SW  functions  for  undocking  are: 

a)  Configure  all  GN&C  systems  for  the  next  mission  phase. 

b)  Schedule  undocking. 

c)  Compute  and  command  AV  translations. 

d)  Provide  capability  to  advance  inertial  state  vector  from  an 
initial  state  to  a final  state. 

e)  Provide  for  specific  force  integration  updates  of  relative 
state  during  burns  associated  with  undocking. 

f)  Compute  and  command  attitude-hold  RCS  AV  maneuvers. 

Figure  1 displays  a function  flow  diagram  of  the  docking  GN&C  software 
functions . 
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9.10  DOCKING  AND  UNDOCKING  (con't) 

Presently,  no  specific  sensors  for  automatic  docking  have  been 
baselined.  However,  control  laws  and  a navigation  routine  have  been  ap- 
proved by  the  GN&C  Software  Equation  Formulation  and  Implementation  Panel. 
These  equation  formulations  are  described  in  the  following  references: 

a)  E.  T.  Kubiak,  "Automatic  Docking  Control  Law,"  MSC 
EG2-3-71,  date  5 January  1971. 

b)  E.  P.  Blanchard,  G.  M.  Levine,  "Docking  and  Undocking 
Navigation,"  MIT  No.  2-71,  dated  January  1971. 
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9.10  DOCKING  AND  UNDOCKING  (cont’d) 


Figure  1 

Overall  Functional  Flow  Diagram 
for  Docking  and  Undocking 
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9.10  DOCKING  AND  UNDOCKING  (cont'd) 


SPACE  SHUTTLE 

GN&C  SOFTWARE  EQUATION  SUBMITTAL 


Software  Equation  Section  Docking  and  Undocking  Submittal  No.  5 

Function  Relative  Navigation 

Module  No.  ON 3 Function  No.  -2,  -5,  -8 (MSC  03690) 

Submitted  By:  E.  P.  Blanchard,  G.  M.  Levine  Co.  MIT 

(Name) 

Date : January  1971 

NASA  Contact:  W.  H.  Peters Organization  EG2 

(Name) 
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Summary  Description:  The  objective  of  the  Docking  and  Undocking 

Navigation  Program  is  to  use  the  data  from  the  docking  sensor  to 
determine  the  relative  position  and  attitude  of  the  target  vehicle 
with  respect  to  the  shuttle.  These  quantities  and  their  rates  are 

computed  periodically  and  used  in  the  generation  of  guidance 

commands  during  both  the  docking  and  undocking  procedure. 

Shuttle  Configuration:  (Vehicle,  Aero  Data,  Sensor,  Et  Cetera) 

Assumes  a docking  sensor  which  measures  the  azimuth  and  elevation 
angles  to  each  of  four  sources  located  on  the  target  vehicle. 

Comments : 

(Design  Status)  The  algorithm  for  source  identification  is  TBD. 


(Verification  Status)  Open-loop  testing  has  been  performed  simulating 
the  sensor-target  geometry  and  the  sensor. 

Panel  Comments : The  equations  are  baselined  subject  to  the  qualifica- 

tion that  they  are  based  on  a sensor  configuration  which  has  not  been 
baselined.  Also,  the  range  and  range  rate  computations  must  be  co- 
ordinated with  those  in  the  Automatic  Docking  Control  Law. 
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9.10.1  Docking  and  Undocking  Navigation 


1.  INTRODUCTION 


The  objective  of  the  Docking  and  Undocking  Navigation 
Program  is  to  use  the  data  from  the  docking  sensor  to  determine  the 
relative  position  and  attitude  of  the  target  vehicle  with  respect  to  the 
shuttle.  These  quantities  and  their  rates  are  computed  periodically 
and  used  in  the  generation  of  guidance  commands  during  both  the 
docking  and  undocking  procedure. 

The  docking  sensor  measures  the  azimuth  and  elevation 
angles  to  each  of  four  sources  located  on  the  target  vehicle.  The' 
configuration  of  these  four  sources  is  designed  to  permit  recognition 
of  one  source  by  its  angular  position  relative  to  the  other  sources 
under  all  allowable  rotations  of  the  shuttle  with  respect  to  the  target 
vehicle  within  certain  restricted  operating  limits.  As  long  as  the 
operating -limit  restrictions  are  satisfied,  it  is  not  necessary  for  the 
sensor  to  identify  individually  the  sources;  i.  e. , the  sensor  portion 
of  the  system  does  not  have  to  associate  a particular  source  with 
each  set  of  azimuth  and  elevation  angles,  that  process  can  be  ac- 
complished computationally.  Furthermore,  in  this  case,  the  data 
from  only  three  of  the  four  sources  are  required  to  obtain  a complete 
relative  position  and  attitude  solution.  The  velocity  and  attitude  rates 
are  determined  by  numerically  differencing  two  position  and  attitude 
solutions. 

On  the  other  hand,  if  the  operating-limit  restrictions  are 
violated,  then  the  equations  have  multiple  solutions,  and  all  four  sets 
of  data  must  be  used  to  resolve  the  ambiguities. 

An  additional  reason  for  the  presence  of  four  sources  is  to 
provide  an  option  for  selecting  the  best  combination  of  three  sources; 
i.  e. , at  close  range  to  permit  selection  of  sources  which  fall  within 
the  sensor  field  of  view,  and  at  long  range  at  provide  a combination 
of  three  sources  which  yield  a more  accurate  solution. 
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NOMENCLATURE 

Intermediate  matrix 
Azimuth  angle  to  source  i 
Intermediate  matrix 
Cos  40° 

Elevation  angle  to  source  i 
Rate  indicator 
Flag  used  in  iteration 
Flag  used  in  rate  calculation 
Negative  radicand  indicator 

Unit  vectors  along  shuttle  coordinate  axes 


Unit  vectors  along  target  vehicle  coordinate  axes 


0.4  or  2.  5 depending  on  selected  source  set 
Index  used  in  rate  calculations 
Transformation  matrix 
Index  used  in  rate  calculations 
Element  of  M 

Index  used  in  rate  calculations 
Source  set  indicator 
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9 # 10 . 1 Docking  and  Undocking  Navigation  (con^) 
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Relative  position  vector  between  docking  hatches 

Rate  of  change  of  r 

Vector  from  sensor  to  source  i 

Magnitude  of  r. 

Vector  from  source  i to  source  j 
Magnitude  of  r 
Maximum  value  of  s. 

Iteration  interval  end  points 

Sin  40° 

Trial  value  of  r^ 

Vector  from  sensor  to  shuttle  docking  hatch 
Vector  from  source  1 to  target  vehicle  docking  hatch 

2 l'  2 2*  2 3 
Rate  of  change  of  7 


At 
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Rotation  angles 
S1  ' rl 

Previous  value  of  Ar 
Navigation  cycle  time 
Error  tolerance 

Angle  between  lines-of-sight  to  sources  i and  j 
Scaling  factor 


Subscript  S Shuttle  coordinates 

Subscript  T Target  vehicle  coordinates 
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9.10.1  Docking  and  Undocking  Navigation  (con't) 


2 . SOURCE  CONFIGURATION  AND  OPERATING  LIMITS 

In  this  section,  the  configuration  of  the  four  sources  on  the 
target  vehicle  is  described,  and  the  operating  limits  under  which  a 
unique  relative  position  and  attitude  solution  can  be  obtained  is  dis- 
cussed. 


Refering  to  Fig.  1,  define  a coordinate  system  fixed  in  the 
target  vehicle  with  origin  at  source  1;  X axis  parallel  to  the  docking 
axis;  and  i_XT,  i_YT,  and  -ZT  unit  vectors  along  the  three  axes.  Let 
r.j  be  the  vector  from  source  i to  source  j.  Then  the  locations  of 
sources  2,  3,  and  4 are  defined  by 


where  the  subscript  T denotes  target  vehicle  coordinates  and  p is  a 
scaling  factor. 

In  order  to  discuss  the  restricted  operating  limits,  define  a 
coordinate  system  centered  at  the  docking  sensor  in  the  shuttle  with 
unit  vectors  i_Xg,  i_YS,  and  i_zg  along  its  axes.  Again,  let  the  X axis 
be  parallel  to  the  shuttle  docking  axis.  Let  y ^ y 2<  and  y 3 be  the 
three  rotation  angles  which  make  the  shuttle  coordinate  system  pa- 
rallel to  the  target  vehicle  system  (the  condition  required  for  docking); 
i.  e.  , a rotation  of  the  shuttle  system  about  the  X axis  through  an 
angle  y ^ then  a rotation  about  the  resulting  Y axis  through  an  angle 
y 2>  and  finally  a rotation  about  the  resulting  Z axis  through  an  angle 
7 3 make  the  two  systems  parallel. 
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-XT 


Figure  1 TARGET  VEHICLE  COORDINATE  SYSTEM  AND 
SOURCE  CONFIGURATION 


9.10-9 


9.10.1  Docking  and  Undocking  Navigation  (con't) 


If  the  X ( docking ) axis  of  the  shuttle  is  kept  within  30°  of 
the  target  vehicle  docking  axis,  then  an  identification  of  the  four 
sources  can  be  made.  Figure  2 illustrates  the  appearance  of  the 
sources  for  various  relative  vehicle  attitudes  for  the  case  of  zero  7^. 
The  center  illustration  shows  the  appearance  of  the  sources  when  the 
two  vehicles  are  properly  aligned  for  docking;  the  other  eight  illus- 
trations show  the  appearance  at  various  points  on  the  surface  of  the 
30°  cone  defining  the  operation  region. 

For  all  relative  vehicle  orientations  within  the  operating 
region,  the  following  two  facts  hold; 

1)  Sources  1,  2,  and  4 lie  on  a straight  line. 

2)  The  observed  distance  between  sources  1 and  2 always 
has  the  same  ratio  with  respect  to  the  observed  dis- 
tance between  sources  1 and  4. 

These  two  facts  permit  identification  of  the  four  sets  of  paired  azimuth 
and  elevation  angles  with  the  four  sources. 

The  source  configuration  has  also  been  selected  to  assure 
that  for  all  relative  vehicle  orientations  within  the  30°  operating  re- 
gion the  distances  from  the  sensor  to  the  sources  will  satisfy  the 
relationship  r1  < < rg  < r^.  This  relationship  provides  the  resolu- 

tion of  the  multiple  solutions  which  would  otherwise  exist  in  the 
navigation  equations. 
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9.10.1  Docking  and  Undocking  Navigation  (con't) 


Figure  2 APPEARANCE  OF  SOURCES  VS  RELATIVE 
VEHICLE  ATTITUDE 
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9.10.1  Docking  and  Undocking  Navigation  (con't) 


3.  FUNCTIONAL  FLOW  DIAGRAM 


The  sequencing  of  functions  performed  by  the  Docking  and 
Undocking  Navigation  Program  is  described  in  this  section  and  illus- 
trated by  the  functional  flow  diagram  in  Fig.  3. 

The  program  is  called  periodically  by  the  Docking  and  Un- 
docking Guidance  Program.  The  first  function  performed  is  to 
identify  the  four  sources  from  the  two  facts  discussed  in  Section  2. 
Next,  the  appropriate  sources  are  selected  and  the  unique  relative 
position  and  attitude  solution  is  determined.  Included  in  this  solution 
is  the  relative  position  of  the  two  docking  hatches.  The  final  step  is 
to  compute  velocity  and  angle  rates  by  differencing  two  solutions  for 
position  and  angle. 


4.  PROGRAM  INPUT-OUTPUT 


The  required  inputs  to  the  program  are  the  four  sets  of 
azimuth  and  elevation  angles  of  the  four  sources  relative  to  the  dock- 
ing sensor;  and  two  indicators,  the  first  of  which  indicates  which  of 
the  two  combinations  of  three  sources  ( 1,  2,  and  3 ) or  ( 1,  2,  and  4) 
have  been  selected,  and  the  second  is  used  in  the  rate  calculations. 
The  outputs  of  the  program  are  solutions  for  the  relative  position  of 
the  two  docking  hatches,  the  rotation  angles  between  the  two  vehicles, 
and  the  rates  of  change  of  these  quantities. 


Input  Parameters 


<a2.  e2> 
( a3*  e3) 


Four  sets  of  paired  azimuth  and  elevation  angles  but  not 
identified  with  any  of  the  four  sources 


9.10-12 


9.10.1  Docking  and  Undocking  Navigation  (con't) 


Enter  from  Guidance 


Exit  to  Guidance 


Figure  3 FUNCTIONAL  FLOW  DIAGRAM 
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9.10.1  Docking  and  Undocking  Navigation  (con't) 


The  elevation  angle  is  the  angle  between  the  line-of-sight  and  the  XY 
plane  of  the  shuttle  coordinate  system.  The  azimuth  angle  is  the  angle 
between  the  X axis  of  the  shuttle  coordinate  system  and  the  projection 
of  the  line-of-sight  on  the  XY  plane.  See  Figure  4. 


P 


Source  set  indicator 


{2  if  selected  source  set  is  ( 1, 2,  3 ) 
4 if  selected  source  set  is  (1,3,4) 


Number  of  cycles  separating 
f Rate  indicator  = differenced  solutions  in  rate 

calculations. 


Output  Parameters 


rc  Position  vector  of  target  vehicle  docking 

— b 

hatch  relative  to  shuttle  docking  hatch  in 
shuttle  coordinates 


Rate  of  change  of  £g 


2.  r <7  1,72'73>  = Rotation  angles 

• • • • 

X = ('y1*72’^3)  = Rates  of  change  of  rotation  angles 


5 . DESCRIPTION  OF  EQUATIONS 

The  computational  sequence  during  the  Docking  and  Undock- 
ing Navigation  Program  and  the  related  equations  are  described  in 
this  section.  These  equations  are  recomputed  every  guidance  cycle. 


9.10-14 


9.10.1  Docking  and  Undocking  Navigation  (con't) 


5.  1 Source  Identification  (TBD) 

The  l'irst  step  in  the  program  is  to  associate  each  of  the 
four  sets  of  azimuth  and  elevation  angles  with  a particular  source. 
The  procedure  for  performing  the  association  is  based  on  the  two 
facts  discussed  in  Section  2;  i.  e.  , 

1)  Sources  1,  2,  and  4 lie  on  a straight  line. 

2 ) The  observed  distance  between  sources  1 and  2 has 
the  same  ratio  with  respect  to  the  observed  distance 
between  sources  1 and  4. 

The  algorithm  used  is  TBD. 

5.2  Angles  Between  Lines -of -Sight 

The  cosines  of  the  three  angles  between  the  lines -ol-sight 
from  the  sensor  to  the  sources  in  the  selected  set  ( based  on  indica- 
tor p)  are  computed  from 


cos  = cos  e^  cos  e^  cos  (a.  - a^ ) 


+ sm  e.^  sin  e 


for 


ij  = 13,  lp,  and  3p 
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9.10.1  Docking  and  Undocking  Navigation  (con*!) 

5.3  Distances  to  Sources 

Let  r ^ £3^  and  £^  be  the  vectors  from  the  sensor  to 
the  four  sources.  The  magnitudes  of  the  three  vectors  associated 
with  the  selected  sources  satisfy 


r3  = rl  COS  013  + \ 

r132  - d - cos2  ei3}  ri2 

r2  = r3  COS  032  ' \ 

r322  - ( 1 - cos2  032  ) r32 

ri  = r2  COS  ei2  ' \ 

ri2  " ^ 1 cos  012  ^ r2 

r3  = rl  cos  013  + \l 

r132  - (1  - cos2  013)  r* 

r4  = r3  C0S  e34  + \ 

1 

r342  - ( 1 * cos2  034)  r32 

rl  = r4  cos  014  - \ 

r142-(l  -cos2ei4)r42 

These  equations  are  solved  by  an  iterative  interval-halving  process  in 
which  sx,  a trial  value  of  r^  is  used  as  input  to  compute  an  output 
value  of  r^  by  means  of 


r3  = rl  C0S  e!3  +\ 

rI32  - (1  - cos2  ei3) Sl2 

rp  = r3  C0S  % ± \ 

r3p2  - (1  - cos2  03p>  r32 

n * rP  cos  hP  - \ 

rlp2-(l  -cos20lp)  rp2 

where  the  upper  and  lower  signs  correspond,  respectively,  with  p=4 
and  p=2.  Agreement  between  s and  r indicates  a correct  solution. 
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9.10.1  Docking  and  Undocking  Navigation  (con't) 


The  iteration  is  initiated  by  computing  the  maximum  possible 
value  for  ^ based  on  the  sensor  measurements 


13 


"M 


\ll  - 


COS  0^2 


Then,  using  rM  as  the  first  value  for  values  for  r^,  r and 
are  computed  from  Eq.  ( 1 ).  During  these  calculations,  it  is  possible 
for  one  of  the  radicands  to  be  negative,  in  which  case  the  selected 
value  of  s is  too  large.  If  this  occurs,  the  value  of  s1  is  halved,  and 
the  computations  are  repeated.  The  process  continues  until  three 
real  numbers  are  obtained  for  r^,  r , and  r^  as  functions  of  s^.  (It 
should  be  noted  that  once  a value  of  s1  which  produces  a real  solution 
has  been  determined,  then  all  smaller  values  of  Sj  will  also  yield  a 
real  solution.  ) 

The  difference  between  the  input  and  output  values  of  ^ is 
computed  from 


Ar  = s1  - r1  ( 2 ) 

Assuming  that  a negative  radicand  did  not  occur,  the  value  of 

s.  is  halved,  and  new  values  for  r„,  r.,  r and  Ar  are  computed.  If 
l o j l 

no  sign  change  in  Ar  occurs,  then  Sj  is  again  halved  and  the  procedure 
repeated  until  a polarity  change  in  Ar  occurs.  When  the  sign  change 
does  occur,  the  last  selected  value  of  s ^ is  increased  by  one  half  its 
value  and  the  polarity  of  the  new  resulting  Ar  is  tested.  This  interval- 
halving procedure,  increasing  or  decreasing  s^  by  one  half  of  each 
increment  taken,  is  repeated  until  the  difference  Ar  is  less  than  the 
desired  error  level  e. 

This  procedure  is  based  on  the  fact  that  Eqs.  ( 1 ) and  (2  ) 
represent  Ar  as  a continuous  function  of  s^.  If  there  are  two  values 
of  s^,  one  of  which  yields  a positive  value  of  Ar  and  the  other  a nega- 
tive value,  then  there  is  some  value  of  s^  between  these  two  values 
for  which  Ar  is  zero  - the  desired  condition. 
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9.10.1  Docking  and  Undocking  Navigation  (con 1 1) 


During  the  first  calculation  of  Ar,  if  a negative  radicand  re- 
sults, then  a special  procedure  must  be  followed  after  the  value  of  s^ 
which  yields  real  values  is  found.  Whereas  in  the  first  case  it  is 
known  that  the  correct  value  of  s^  is  not  larger  than  r„,  in  this  case 
the  solution  could  be  larger  than  the  value  of  s^  for  which  real  (but 
incorrect)  values  ot  r^,  r , and  r^  resulted.  This  ambiguity  is  re- 
solved by  performing  one  pass  through  Eqs.  ( 1 ) and  ( 2 ) with  Sj  equal 
to  zero.  Comparison  of  the  sign  of  the  resulting  Ar  with  the  sign  of 
the  previous  Ar  indicates  whether  s^  should  be  increased  or  de- 
creased. This  same  procedure  is  used  if,  during  an  increase  in  s^,, 
a negative  radicand  occurs. 

The  details  of  the  iterative  procedure  are  shown  in  the  flow 
diagrams  of  Section  6, 


5.4  Source  Position  Vectors  . 

The  position  vectors  of  the  three  selected  sources  are  ob- 
tained from 


cos  e.  cos  a. 

i . l 

r 'c  = r.  I cos  e.  sin  a. 

-lb  1 I 1 1 


sin  e. 

l 


/ 


(i  c 1,  3,  p) 


where  the  subscript  S denotes  shuttle  coordinates. 


5.  5 Transformation  Matrix 

The  transformation  matrix  M from  shuttle  to  target  vehicle 
coordinates  is  computed  from 

MT  = AB 

where 


= *-13S 


-IpS 


-13SXIfpS) 
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9.io.: 
B = ( 


Docking  and  Undocking  Navigation  (con't) 


— 13T  — lpT  -13TX-lpT) 


C = cos  40° 
S = sin  40° 


r0,4  if  p = 2 

K J 

l2.  5 if  p = 4 

— 1 3S  = ^3S  ' -IS 
-IpS  = £pS  ' -IS 


Rotation  Angles 

The  rotation  angles  y j , y and  7^  are  obtained  from 


sin  (m31) 


-1  m21 
-sin  ( — — ) 

cos  7 2 

-1  m 32 
-sin  ( ££_) 

cos  7 2 
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w in  win 


9.10.1  Docking  and  Undocking  Navigation  (con't) 


where  m^,  m21’  m32  are  elements  of  M according  to 


mll  m12 

m 13 

m21 

m22 

m23 

m3 1 

m32 

m33  j 

5-  7 Relative  Position  Vector  Between  Docking  Hatches 

The  position  of  the  target  vehicle  docking  hatch  relative  to 
the  shuttle  docking  hatch  is  computed  from 

£s  = - Zs  +— is  + 

where  y and  are  the  locations  of  the  shuttle  and  target  vehicle  dock- 
ing hatches  relative  to  their  respective  coordinate  system  origins,  and 
the  S and  T subscripts  indicate  shuttle  and  target  vehicle  coordinates. 
Note  that  yg  and  zT  are  fixed  constants. 


5.8  Velocity  and  Attitude  Rate 


The  estimated  relative  velocity  and  estimated  relative  at- 
titude rate  of  the  two  vehicles  are  computed  by  differencing  the 
current  relative  position  and  attitude  solution  with  the  solution  f 
cycles  in  the  past  as  follows: 


7 i ( t ) - 7 i ( t - f At ) 


/ f At 


(i  = 1,  2,  3) 


t ) - £g  ( t - f At  ) 


/ fAt 
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9.10.1  Docking  and  Undocking  Navigation  (con't) 


During  the  first  cycle,  no  rate  information  can  be  computed, 
and  during  cycles  2 through  f,  the  current  and  the  first  solutions  are 
used  in  the  calculations. 

This  procedure  provides  smoother  estimates  of  the  rates 
from  cycle  to  cycle  than  if  successive  values  of  relative  position  and 
attitude  were  used. 


6 . DETAILED  FLOW  DIAGRAMS 

This  section  contains  detailed  flow  diagrams  of  the  Docking 
and  Undocking  Navigation  Program. 
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9.10.1  Docking  and  Undocking  Navigation  (con't) 


Figure  5b  DETAILED  FLOW  DIAGRAM 
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Figure  5c  DETAILED  FLOW  DIAGRAM 
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9.10.1  Docking  and  Undocking  Navigation  (con't) 


— 13S  = ^3S  " -IS 
-1PS  = ^pS  " -IS 


K = 0.  4 


Figure  5d  DETAILED  FLOW  DIAGRAM 
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Figure  5e  DETAILED  FLOW  DIAGRAM 
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9.10.1  Docking  and  Undocking  Navigation  (con't) 


Figure  5f  DETAILED  FLOW  DIAGRAM 
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9.10.1  Docking  and  Undocking  Navigation  (con' t)  - 

7.  SUPPLEMENTARY  INFORMATION 

The  Docking  and  Undocking  Navigation  Program  described 
in  this  report  has  been  operated  as  an  open  loop,  simulating  the 
sensor-target  geometry,  the  sensor,  and  the  computations  yielding 
as  outputs  the  relative  state  vector  and  attitude  between  vehicles. 

The  program  is  valid  and  the  configuration  chosen  performs  as  ex- 
pected. A chart  and  tabulated  results  appear  in  Ref.  1. 

It  is  planned  to  continue  the  present  program  effort  to  provide 
a closed  loop  capability  which  will  include  a guidance  law  for  Dock- 
ing and  U ndocking,  and  an  autopilot  with  capability  to  operate  with  the 
guidance  law  and  the  vehicle  and  engine  characteristics.  The  navi- 
gation program  will  be  modified  to  incorporate  Kalman  Filtering 
which  should  enhance  the  navigation  and  provide  better  assessment 
of  the  relative  state  vector.  It  is  also  planned  to  add  a scale  change 
or  zoom  capability  to  the  sensor  model  used  such  that  improvement 
in  the  accuracy  of  the  state  vector  can  be  achieved  at  long  ranges. 


A simplified  guidance  law  will  be  implemented  initially  with  growth 
to  more  sophisticated  guidance  laws  as  deemed  necessary. 


9.10-29 


9.10.1  Docking  and  Undocking  Navigation 


Reference 


Blanchard,  Earle  P.  , NAS  9-10268  Automatic  Docking  GN&  C 
Equation  Development,  21  December  1970,  70-408L-7. 
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SPACE  SHUTTLE 


GN&C  SOFTWARE  EQUATION  SUBMITTAL 


Software  Equation  Section  Docking  and  Undocking  Submittal  No . 3 

Function  Automatic  Docking  Control  Law 

Module  No.  0C4  Function  No.  -4,  -6 (MSC  03690). 

Submitted  By;  E.  T.  Kubiak Co.  MSC/GCD 

(Name) 

Date ; January  26,  1971 

NASA  Contact;  W.  H.  Peters Organization  EG2 

(Name) 

Approved  by  Panel  III  K.  J.  Cox  ^ _D at e January  26,  1971 

Summary  Description:  The  automatic  docking  control  laws  provide  the 

attitude  and  translational  commands  for  the  docking  procedure  which 
is  defined  to  begin  at  a range  of  1000  ft.  The  procedure  involves 
two  sequential  control  tasks.  The  first  brings  the  orbiter  within 
stationkeeping  range  (-150  ft.)  and  the  second  accomplishes  docking 
with  minimum  docking  hardware  contact  position  dispersions. 

Shuttle  Configuration:  (Vehicle,  Aero  Data,  Sensor,  Et  Cetera) 

No  docking  sensor  configuration  is  defined  but  jet  accelerations 
are  assumed. 


Comments : 

(Design  Status)  The  design  is  in  the  conceptual  stage  with  required 
filters  still  to  be  designed. 

(Verification  Status)  Will  be  simulated  on  an  orbiter  docking 

engineering  simulator. 

Panel  Comments : The  range,  range  rate,  and  relative  attitude  computations 

in  these  equations  must  be  coordinated  with  similar  computations  in  the 
Docking  and  Undocking  Navigation  equations. 
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9.10.2  Automatic  Docking  Control  Law 
1.  Introduction 

The  docking  procedure  is  defined  to  begin  at  a range  of  approxi- 
mately 1000  feet.  From  this  point,  there  are  two  sequential  control 
tasks.  The  first  task  is  to  bring  the  orbiter  within  stationkeeping 
range,  say  150  feet,  with  a lateral  displacement  of  10  feet  or  less  from 
the  desired  approach  path  and  relative  rates  of  one  half  ft/sec/axis  or 
less.  The  second  control  task  is  a successful  docking  with  minimum 
docking  hardware  contact  position  dispersion  and  transmitted  impulses. 

Significant  improvements  over  the  original  control  law  (Refer- 
ence 1)  are  (1)  minimum  use  of  relative  angle  measurements  which  have 
large  errors,  (2)  direct  control  of  the  probe  tip  which  provides  tighter 
control,  and  (3)  reduced  time  for  the  docking  procedure  due  to  improved 
logic.  The  first  two  points  are  also  discussed  in  the  reference. 

In  generating  this  control  law,  the  following  assumptions  have 
been  used  as  ground  rules: 

a)  Measured  quantities  available  from  the  sensors  are 
range,  R;  LOS  (line-of-sight)  angles  for  pitch,  a, 
and  yaw,  0;  and  relative  orbiter /target  attitude 
(<t>R,  6r,  Tr)  . As  the  orbiter  is  to  be  autonomous, 
no  other  information  (e.g. , target  position  or 
attitude)  is  available  from  ground  tracking  or 
computer  initialization. 

b)  Range  and  LOS  angle  measurements  will  have  greater 
accuracy  than  relative  attitude  angle  measurements 
(particularly  at  longer  ranges). 

c)  It  is  desirable  to  have  at  least  a brief  station 
keeping  period  prior  to  the  final  phase  (assumed 
to  begin  at  100  ft  range)  of  docking,  providing 
the  opportunity  for  a final  check  of  thrusters, 
docking  mechanisms,  GN&C  systems,  and  sensor 
systems. 

d)  The  docking  procedure  begins  at  approximately 
1000  ft  range  and  should  conclude  in  5 to  10 
minutes  (plus  any  time  spent  in  the  station 
keeping  mode) . 
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9 . 10 . 2 Automatic  Docking  Control  Law  (conVt) 


e)  Sensor  measurements  provide  the  only  available 

information  with  regards  to  the  passive  vehicle's 
relative  state  (no  data  link).  f 

f)  It  is  assumed  that  the  target  vehicle  is  under, 
attitude  control  and  that  any  target  vehicle 
motion  due  to  attitude  control  limit  cycling  is 
negligible  (a  good  assumption  for  CMG  control). 


Nomenclature 


a 

a 

3 

K 


LOS 


R 


R 


u 


-BODY 


Translational  acceleration 
LOS  pitch  angle 
LOS  yaw  angle 

Factor  in  phase-plane  switching  lines 
representing  the  relative  importance 
of  time  vs.  fuel  minimization 

Distance  along  +X  body  axis  from 
orbiter  c.g.  to  sensor  location 

Line-of-sight 

Relative  orb iter/target  roll  attitude 
Relative  orbiter/target  yaw  attitude 
Range 

Total  closure  time 

Relative  orbiter/target  pitch  attitude 

i'F  yaw  torques 
±0  pitch  torques 
±y  thruster  forces 
±Z  thruster  forces 
Orbiter  body  rate 


9.10-33 


9.10.2  Automatic  Docking  Control  Law  (con't) 


^OS 


X » Y , Z 
eg  eg  eg 

^CS’  ylcs’  zlcs 


X , Y 
P P 


Z 

P 


LOS  angular  rate 

Initial  separation  distance 

Initial  closing  rate 

C.G.  position  errors 

Position  errors  in  LOS  coordinate 
system 

Probe  position  errors 
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9.10. 2 


Automatic  Docking  Control; Law  (con't) 


2-  Coordinate  System  Definition 

Before  proceeding  to  equation  formulation,  the  following  coordi- 
nate systems  must  be  defined  (see  also  Figure  1). 

a)  Body  coordinate  system  (BCS)  - origin  at  c.g.  of 
+X  axis  towards  nose  along  centerline,  +Y  towards 
right  wing,  +Z  down. 

b)  Sensor  coordinate  system  (SCS)  - sensor  and  docking 
mechanism  location  assumed  coincident  along  +X  body 
axis  at  distance  £ from  orbiter  c.g.,  which  also 
defines  the  origin  location.  Direction  of  axes, 
same  as  body  axes. 

c)  LOS  Coordinate  System  (LCS)  - origin  same  as  the 

SCS.  Direction  of  axes  defined  by  LOS  pitch  and 
yaw  rotations  from  SCS  +X  axis.  ; 

d)  Target  coordinate  system  (TCS)  - origin  located 

at  passive  vehicle  docking  mechanism  assumed 
coincident  with  reflectors.  -X  axes  defines  the 
desired  final  approach  path.  Y and  Z complete 
the  right  hand  system.  \ 

Functional  Flow  Diagram 

The  sequencing  of  functions  performed  by  the  Automatic  Docking 
Control  Law  is  described  in  this  section  and  illustrated  in  the  functional 
flow  diagram  in  Figures  2a  and  2b. 

The  program  calculates  the  probe  to  target  vector  and  determines 
whether  Phase  1 or  Phase  2 control  is  desired.  If  Phase  1 control  is  re- 
quired, calculate  the  position  and  velocity  errors  for  phase-plane  control 
using  the  sensor  measured  pitch  and  yaw  LOS  angles,  c.g,  to  target  range, 
and  the  estimated  vehicle  to  target  attitude.  Based  on  these  values  for 
position  and  velocity  errors,  enter. the  X,  Y,  and  Z-axis  phase-plane 
control  logic  and  compute  translational  commands. 

For  Phase  2 control,  compute  the  range  position  error  using  the 
sensor  measured  pitch  and  yaw  LOS  angles,  c.g.  to  target  range,  and  the 
estimated  vehicle  to  target  attitude.  Passing  this  signal  through  a 
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9.10.2  Automatic  Docking  Control  Law  (cont'd) 


Figure  2a.  Phase  I Control  Functional  Flow  Diagram 


Phase  2 Region 
(see  Figure  2b) 
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Phase  2 Control  Region 


Perform  CSM  RCS-type  roll 
attitude  control 


Return  to  probe  to  target 
vector  calculation 


Figure  2b.  Phase  II  Control  Functional  Flow  Diagram 
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9.10.2  Automatic  Docking  Control  Law  (con* t) 

filter,  obtain  the  rate  error.  Enter  the  range  control  phase-plane  logic 
to  compute  jet  firing  times  for  X-axis  translation  control.  Compute  the 
lateral  position  errors  of  the  probe  and  c.g.  and  determine  the  res- 
pective rates  by  a filtering  routine.  Enter  the  c.g.  and  probe  phase- 
plane  logics  to  obtain  coordinated  ±Z  thruster  firings  and  ±0  pitch 
torques  for  Z-axis  and  pitch  control,  and  coordinated  ±Y  thruster  firings 
and  ±¥  yaw  torques  for  Y-axis  and  yaw  control. 


The  docking  sensors  have  not  been  baselined,  but  in  , this  develop- 
ment, basic  inputs  have  been  identified.  These  inputs  include  range, 

LOS  pitch  and  yaw  angles,  relative  orbiter/target  attitude,  body  rates, 
the  distance  between  the  orbiter  c.g.  and  probe  as  measured  along  the 
+X  body  axis,  and  estimates  of  the  RCS  jet  control  authorities.  The 
outputs  of  the  program  are  RCS  jet  firing  times. 


Range  between  orbiter  and  target  vehicle 
LOS  pitch  angle  , , 

LOS  yaw  angle  , 


4>r  Relative  orbiter/target  roll  angle 

eR  Relative  orbiter/target  pitch  angle 

Relative  orbiter/target  yaw  angle 


-BODY 


Orbiter  angular  rates 


1 Distance  between  orbiter  c.g.  and  probe 

as  measured  along  +X  body  axis 

a Translational  acceleration  capability 

of  the  orbiter  (lateral  and  ±X  body) 

^ ^CS  translational  acceleration  along 

Y and  Z axes 
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9.10.2  Automatic  Docking  Control  Law  (con't) 


uq»  Uy  RCS  angular  acceleration  about  pitch 

and  yaw  axes 

Output  Parameters 

Region  X RCS  jet  firing  time  (and  sign)  for 

various  regions  of  the  phase-plane 
logics 


5.  Description  of  Equation 

5.1  Phase  I Control 

Phase  1 is  defined  as  the  control  period  during  which  the 
orbiter  is  brought  from  some  post  rendezvous  state  (range  about  1000 
feet)  into  the  stationkeeping  state.  In  the  sequence  of  control  actions, 
the  first  step  is  to  define  as  a pitch/yaw  reference,  the  LOS  vector  from 
the  sensor  to  the  target  (i.e. , a = g = 0,  see  Figure  3). 

The  roll  reference  is  defined  such  that  Z is  parallel  to  Z T 
(i.e.,  the  relative  roll  angle  is  zero).  The  attitude  error,  (cf>R,  a,  g) 
will  change  slowly  due  to  relative  motion  and  vehicle  body  rotation. 

This  error  will  be  measured  and  filtered  once  per  second.  Control  logic 
will  be  basically  the  same  as  the  CSM  RCS  DAP  with  a deadband  of  5°. 

When  the  vehicle's  attitude  is  within  the  deadband  for  all  three  axis 
translational  control  is  begun. 

In  the  translational  control  formulation  the  TCS  is  considered 
to  be  inertial  (orbiter  mechanics  neglected).  The  control  problem  is 
to  translate  the  orbiter  from  its  initial  state  to  a limit  cycle  region 
which  has  as  its  position  reference  (-150,  0,  0)  in  the  TCS.  The  ideal 
trajectory,  time  and  fuel-wise,  is  the  straight  line  between  the  initial 
condition  and  (-150,  0,  0)  in  the  TCS.  One  of  the  more  precise  control 
processes  which  could  be  used  to  follow  this  trajectory  is: 

a)  Generate  displacement  and  rate  vector  in  the 
TCS  from  measurements  and  matrix  computations. 
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9.10.2  Automatic  Docking  Control  Law  (cont’dV 

PITCH  (Xs,  Z$)  PLANE 


Figure  3 

LOS  Angle  Definition 
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9.10.2 


Automatic  Docking  Control  Law  (con't) 


b)  Select  a delta  V to  (1)  null  velocity  component 
normal  to  displacement  vector,  and  (2)  provide 
the  desired  closing  rate  along  the  displacement 
vector. 

c)  Determine  components  of  delta  V in  BCS  and  im- 
plement commands. 

d)  Reiterate  computations  to  null  residual  errors. 

The  performance  of  such  a process  would  be  very  dependent  on  the 
relative  angle  measurements  used  in  numerous  matrix  multiplications. 

As  these  measurements  are  not  highly  accurate,  particularly  at  initializa- 
tion range  (1000  ft  or  more) , another  process  will  be  used  which  performs 
the  same  function  and  requires  much  less  computation. 

a)  Compute  position  error  and  vehicle  relative  rates 
in  LCS. 

b)  Input  position  errors  and  relative  rates  to  phase 
plane  switching  logic  to  determine  delta  V commands 

c)  Recycle  according  to  some  selected  sample  frequency. 

For  this  scheme.  Figure  4a  shows  how  the  Z position  error 
is  determined  to  be 


ZLCS  - s*n  ~ ^s:*-na 

Similarly,  Figure  4b  indicates 


Y 

LCS 


-150  sin  (6  + ¥R)  + £sing 


Finally,  the  X position  error  is 


Xlcs  = R + £coseRcos*R  - 150 


The  relative  velocity  of  the  orbiter  with  respect  to  the  target 
vehicle  in  the  LCS  is  equal  to  the  negative  of  the  derivative  of  (R  + 2, ) . 
As  R is  rotating  in  inertial  space  with  an  angular  velocity  of 
^LOS  + WB0DY^  * exPressi°n  for  the  derivative  is 


_d 

dt 


( R + £) 


LOS 


R + 


^%,0S 


+ %0DY^ 


X * + %0DY  X 
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-150 
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Calculation  of  Z 
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9.10.2  Automatic  Docking  Control  Law  (con't) 


Assuming  Is  colinear  with  the  X^g  axis,  then  l_  = [&  0 0]  T 
Also , 


-R~ 

"0" 

V 

R = 

0 

^OS 

a 

-BODY 

e 

\ 

_0_ 

_e_ 

J . 

which  yields  the  following  derivatives 


"^LCS 

YLCS 

ZLCS 


-R 

• • • 

-R(¥r  + 6)  - M»R 

• • • 

R(6r  + a)  + £6r 


Figures  5a  and  5b  show  the  geometry  relating  to  the  Y and  Z 

LCS  LCS 

equations.  It  should  be  noted  in  the  position  and  rate  equations  that 
R and  H are  always  positive  quantities. 

• • . . 

Also,  as  0BODY  and  ^B0DY  very  nearly  equal  0R  and  ¥ and  further 

as  the  body  rates  may  be  known  much  more  accurately  than  the  relative 

angle  rates , 0R  and  ^R  may  be  replaced  in  the  YLCS  and  ZLCg  computations 

by  0BODY  and  ^BODY* 


The  translational  control  law  is  based  upon  the  parabolic  switch- 
ing logic  which  is  the  optimal  control  for  minimizing  time  and  fuel  for 
a 1/s  or  double  integrator  plant.  Figure  6 illustrates  this  optimal 
logic  where  the  available  control  acceleration  is  u = ±a. 


The  factor  K in  the  f2(X)  and  f^(X)  switching  curves  is  the  rela- 
tive importance  of  time  vs.  fuel  minimization  (i.e.,  increasing  K decreases 

• • 

time  and  increases  fuel  and  vice  versa).  As  K 


f2(X) 


f1(X)  and 


^4®  which  is  the  time  optimal  solution  (no  coast  zones).  The 

docking  logic  will  have  separate  values  of  K for  range  control  (X)  and 


lateral  control  (Y,  Z)  and  those  will  be  selected  from  the  allowable 
docking  time  constraints. 
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ylcs  = -Re 


Total  Ylcs  = — R ( ip  + e)  - 

Figure  5a 
YLCS  Calculation 
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2 

For  change  in  eR, 


For  change  in  a. 


• • •#  • 

Total  ZLCS  = R(eR  + a)  + £6r 

Figure  5b 
ZLCS  Calcu^atl*°n 
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9.10.2  Automatic  Docking  Control  Law  (cont*d) 


Figure  6 

Time-Fuel  Optimal  Control  Logic 


9.10.2  Automatic  Docking  Control  Law  (con't) 


5.2  Phase  I Range  Control 

The  maximum  desired  docking  time  is  5 minutes  or  300  seconds  and 

2 

the  control  acceleration  is  .2  ft/sec  (using  two  of  the  available  four 
thrusters  for  finer  control).  Assuming  a worst  case  initial  separation 
and  closing  rate  of  1500  feet  and  zero,  respectively,  the  slowest  possible 
path  is  shown  in  Figure  7 (A  to  B to  C) . 


A to  B is  the  control  trajectory  and  B to  C is  the  slowest 
trajectory  in  the  coast  zone.  Hence,  the  total  closure  time  is 


T 


fcAB  + tBC 


The  equation  for  total  position  change  is. 


y _ 1 a.  1 / 5 

X0  ~ 2 AB  + 2^  (K  + BC 


Also,  as  the  rate  changes  from  A to  B and  B to  C must  be  equal, 

3 tAB  = a + 4^  tBC 
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9.10.2  Automatic  Docking  Control  Law  (con't) 


From  these  three  equations,  one  can  solve  for  K and  K/(K  + 4) 


8X„ 


K 


K 


2X„ 


aT  - 4X„ 


K + 4 


aT  - 2X. 


0 “*  ““0 
For  the  given  values  of  a,  T and  XQ,  K = 1 and  K/ (K  + 4)  = 0.02. 


(1) 


Finally,  to  permit  coasting  between  some  position  deadband, 
modifications  must  be  made  to  the  optimal  logic  shown  in  Figure  6. 
Assuming  a ±5  foot  deadband  the  complete  modified  logic  is  shown  in 
Figure  8. 


Figure  9 defines  the  phase  plane  switching  regions.  In  Region  I, 
the  desired  control  action  is  to  drive  the  rate  to  0.25  ft/sec  (line  seg- 
ment AB).  The  thruster  firing  time  is  determined  from  AX  = at  or 


t 


Region  I 


5 X - 1.25 


(2) 


This  firing  time,  of  course,  should  be  no  longer  than  the  control  sample 
period  to  make  use  of  feedback.  Because  of  inaccuracies  in  modeling  it 
may  be  necessary  to  include  a hysteresis  line  bordering  Region  I to 
eliminate  chattering  (see  Figure  9).  This  will  be  determined  at  a future 
date. 


In  Region  II,  the  desired  control  action  brings  the  state  into 
the  coast  zone  with  an  opposite  rate  sign  (example  trajectory  CD  shown 
in  Figure  9).  The  desired  rate  change  can  be  found  by  first  writing 
the  equation  for  the  trajectory  CD  and  then  simultaneously  solving  this 
equation  with  f^(X).  The  former  equation  is 

l " 9 

X-X-  -i  X2 

1 Xn 

where  X'  = X + — 0 

0 2a 


and  the  latter  X = — (— . 

2a  v K 
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9.10.2  Automatic  Docking  Control  Law  (cont'd) 
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9.10.2  Automatic  Docking  Control  Law  (con't) 


The  intersection  is  given  by 


INT 


INT 


X' 

'■K  + 2)  2 


I aKX' 

K + 2 


Hence,  the  firing  time  is  given  by 
t 


, A / aKX'  X / 

Region  II  0 + V K + 2 = -9.  + a / K 

a V K + 2 a 


(3) 


a 


Finally , Region  III  is  designed  to  provide  smooth  limit  cycle 
operation,  the  control  action  is  to  drive  the  rate  to  zero.  Hence, 


CRegion  III  ~ — ^X0 

a 


(4) 


5.3  Phase  1 Lateral  Control 

Similarly,  K for  lateral  control,  can  also  be  found  from  the 
constraints,  the  acceleration  is  .2  ft/sec2,  maximum  docking  time  equals 
300  seconds  and  maximum  initial  position  and  velocity  errors  of  150  feet 
and  3 ft/sec,  respectively.  Figure  10  shows  the  slowest  trajectory. 
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9.10.  2 Automatic  Docking  Control  Law  (con't) 


Again,  three  equations  can  be  found  to  solve  for  K, 


time, 


T = t + t 

AB  BC 


position,  X0  - (^t2^ 

rate,  a - .(^1^  + |iQ| 


£ 

The  equations  for  K and  (—  — ) are  found  to  be 

K i 4 


K 


Sa  (XQ  + 1xq|t)  - 4 | XQ | 2 

|XQ  | 2 + (aT)2  - 4a  (XQ  + |Xq|t) 


_K_  = 2a  (X  + |X  |T)  - |X  |2 

K + 4 ^ - r-2- 

(aT)2  - 2a  (XQ  + |xq|t) 

K and  (R  + are  calculated  to  be  0.594  and  0.129,  respectively.  Finally, 
Figure  11  depicts  the  lateral  Y,  Z control  logic  which  also  has  a ±5 
foot  deadband  modification.  The  control  regions  and  thruster  firing  times 
are  of  the  same  format  as  that  shown  for  range  control. 


5. 4 Phase  2 Control 

Phase  2 control  begins  at  the  stationkeeping  state  and  ends  at 
contact.  For  a minimum  dispersion  docking  the  following  parameters  and 
their  derivatives  need  to  be  controlled: 

a)  Range 

b)  Lateral  probe  position  errors 

c)  Lateral  c.g.  position  errors 

d)  Relative  roll 

e)  Relative  pitch  and  yaw 


9.10-54 


Figure  11 

Phase  1 Lateral  (Y,Z)  Control 
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9.10.2  Automatic  Docking  Control  Law  (con't) 


5.5  Phase  2 Range  Control 

In  addition  to  the  obvious  constraints  of  maximum  time  to  dock- 
ing and  impact  velocity,  there  may  be  other  constraints;  for  example, 
jet  plume  impingement  restrictions.  However,  until  these  later  con- 
straints are  defined,  they  will  be  neglected. 

The  coordinate  system  used  is  the  TCS.  The  position  error  is 

given  by 

X = R cos  (0  + a)  cos  (<F  + g)  + £cos6T_cos'{L  - £ 

K K R R 

This  quantity  will  be  filtered  to  provide  X. 

The  control  law  will  basically  be  the  same  as  the  previously 
discussed  time-fuel  optimal  logic  with  the  addition  of  a rate  limiting 
zone  for  coasting  during  the  final  "d"  feet  of  the  docking  maneuver 
(see  Figure  12).  f-^(X)  is  the  curve  dictated  by  two  jet  braking.  K for 

^2^)  can  be  determined  by  choosing  a maximum  time  for  reaching  the  rate 
limiting  logic  for  a worst  case  set  of  initial  conditions.  Selecting  a 
maximum  time  of  3 minutes  and  a worst  case  I.C.  of  XQ  = .25  ft/sec  and 
Xq  = 150  feet,  than  K = 0.2734  and  ^ = 0.06404.  For  this  value 

of  K,  it  can  be  shown  that  the  maximum  closing  rate  is  less  than  2 ft/sec. 

The  upper  boundary  in  the  rate  limiting  zone  is  set  by  the 
maximum  impact  velocity  constraint  which  is  assumed  to  be  0.1  ft/sec. 

The  lower  boundary  is  a function  of  maximum  allowable  time  for  coast 
and  the  distance  for  coast,  d.  Assuming  a 100  seconds  and  5 feet,  res- 
pectively, the  lower  limit  is  0.05  ft/sec. 

There  are  three  control  regions.  The  first  is  the  one  lying  to 
the  right  of  the  parabolic  coast  zone  and  above  the  rate  limiting  coast 
zone.  Here  the  control  should  aim  for  a rate  of  0.075  ft/sec  (mid-way 
in  rate  limiting  zone) . 

„ _ X - .075 

Region  I (5) 

a 
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9.10.2  Automatic  Docking  Control  Law  (cont’d) 
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Figure  12 

Phase  2 Range  Control  Phase  Plane 


9.10.2  Automatic  Docking  Control  Law  (con't) 


Region  II  lies  to  the  left  of  the  parabolic  coast  zone  and  the 
line  X = -(d  + .1).  Control  requirement  for  this  region  is  to  bring 
the  state  up  to  the  lower  parabolic  switch  line.  Firing  has  been  derived 
previously  in  a similar  calculation. 


t 


Region  II 


where  X' 


x0  + i 


(6) 


Finally,  Region  III  lies 
and  below  the  rate  limiting  coast 


to  the  right  of  the  line  X = -(d  + .1) 
zone.  The  firing  time  is 


t 


Region  III 


0.075  - X 
a 


(7) 


5.6  Control  of  Lateral  Probe  and  C.  G.  Position  Errors  and 

Relative  Pitch  and  Yaw  Angles 

Lateral  probe  position  error  should  be  controlled  directly  be- 
cause the  allowable  lateral  probe  displacement  at  impact  is  likely  to 
be  quite  small  (one  foot  or  less).  Indirect  control,  by  simply  nulling 
c.g.  position  and  relative  pitch  and  yaw  attitudes,  can  cause  signi- 
ficant lateral  dispersions  (see  reference).  However,  as  lateral  probe 
position  error  is  a function  of  lateral  c.g.  position  errors  and  the 
relative  pitch  and  yaw  angles,  the  controls  for  all  three  must  be  co- 
ordinated. 

Considering  the  X-Z  plane-first  there  are  three  pairs  of  vari- 
ables to  be  controlled  (Z  , Z ) (Z  , Z ) and  (0  , 0 ).  During  this 

P P K K 

phase  of  control  the  two  translational  parameters  will  be  calculated  as 
follows  in  the  TCS  (see  Figure  13). 

Z = R sin  (0^  + a)  + £ sin  8^ 

Z = R sin  (0„  + a) 

p R 
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9.10.2  Automatic  Docking  Control  Law  (con't) 


The  respective  rates  will  be  obtained  by  a filtering  routine  to  be 
determined. 


The  control  inputs  are,  of  course,  the  ±Z  thruster  forces,  u , 

- z 

and  the  ±6  pitch  torques,  uQ , which  are  applied  in  the  following  manner; 

K * “z  ■ e“e 


Cg 


u_ 


R 


Intuitively,  it  can  be  seen  that  explicit  control  of  any  two  of 
the  variables  (Zp,  Z , 0R) , implicitly  controls  the  third.  For  example, 
a control  which  forces  two  of  the  variables  into  prescribed  limit  cycles, 
indirectly  bounds  the  remaining  variable  into  some  limit  cycle.  As  Z 

p 

has  already  been  chosen  as  one  of  the  variables  to  be  controlled  directly, 
it  only  remains  to  select  either  Z cg  or  0R  for  the  other  directly  con- 
trolled variable.  Either  is  acceptable;  however,  Z is  chosen  because 
uQ  has  five  times  more  control  authority  than  uz  and  by  this  choice  £uQ 
can  be  used  exclusively  for  Zp  control.  Summarizing,  at  this  point  we 

have  u for  exclusive  control  of  Z and  £u  for  exclusive  control  of 

eg  u 

Zp  where  uz  is  a known  disturbance  of  Z . In  block  diagram  form,  this 
is  represented  as: 
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9.10.2  Automatic  Docking  Control  Law  (con't) 


As  an  aid  in  defining  the  control,  it  is  helpful  to  visualize 
the  desired  control  state.  Realizing  that  there  is  a minimum  control 
impulse  on  Z ^ and  0^  which  necessitates  deadbands.  Figure  14  indicates 
the  ideal  control  state.  Effectively,  we  have  located  on  the  approach 
path  with  Zcg  moving  up  and  down  in  a deadband . Requirements  for  this 
condition  are 


(1)  2cg  - WR  - 0 

(2)  Z =0 

P 


A method  of  approximating  this  control  state  is  to  (1)  drive  (Z  Z ) 

eg  eg 

into  a deadbanded  limit  cycle  (consistent  with  allowable  0 range) , 

R 

(2)  drive  (Zp,  Z ) into  a very  small  deadband  limit  cycle,  and  (3)  use 

differential  jet  firings  to  approach  Zp  = 0 (i.e.,  take  advantage  of  the 

small  control  impulse  available  from  u - £u  ) . 

Z 0 


A final  consideration  is  that  Z and  Z should  be  within  their 

eg  p 

deadbands  before  the  range  control  has  reached  the  rate  limiting  zone. 

As  the  maximum  closing  rate  is  2 ft/sec,  the  minimum  time  for  this  is 
150/2  or  75  seconds. 


Switching  logic  for  (Z  , Z ) 

I cg  eg 

The  switching  logic  will  have  the  same  form  as  that  used  for 
Phase  1 except  there  will  be  a different  deadband  and  value  of  K for 
the  f2 (X)  function.  The  deadband  is  dependent  on  the  per  axis  allowable 
misalignment  angle,  y. 


Hence,  we  have 


Z DEADBAND  = Jtsiny 
eg  ' 


Assuming  a y of  2°  the  Z deadband  is  2.5  feet.  To  determine  K,  we 

c8 

insert  T = 75  seconds  and  worst  case  initial  conditions  into  the  pre- 
viously derived  formula 
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esired  Contro 


9.10.2  Automatic  Docking  Control  Law  (con't) 

K . 8a  (Xp  + |X0|T)  - 4 | XQ | 2 

|X0|2  + a2!2  - 4a(X0  + |X0|T) 

Assuming  XQ  = 10  ft  and  XQ  = -.25  ft/sec,  K = .2265.  However,  as  the 

value  of  K used  for  Phase  1 control,  0.594,  is  more  conservative  (i.e., 

longer  hence  quicker)  it  will  be  used  for  simplicity  of  logic  coding. 

A final  modification  from  the  Phase  1 logic  is  necessitated  by  the 

differential  jet  firing  technique  which  will  be  used  to  null  Z . It 

P 

requires  the  minimum  delta  V impulses  available  from  the  Z-translation 
and  pitch  jets  to  be  the  same.  As  u^  is  approximately  five  times  smaller 
than  Ug , the  minimum  impulse  from  u^  must  be  increased  proportionately. 
The  control  regions  are  the  same  as  that  previously  used  for  lateral 
control. 


5.7  Switching  logic  for  (Z  , Z ) 

: ! e e_ 


The  control  for  (Z  , Z ) will  also  be  a modified  form  of  the 

r r 

time  - fuel  optimal  switching  logic.  Figure  15  illustrates  this  logic. 
The  linear  acceleration  from  the  pitch  thrusters  is  five  times  greater 
than  that  from  the  translational  thrusters,  hence,  for  two  thruster 
acceleration 


fi(y 


1 ' 2 

ja  ( z r 

2a  p 


y Z 2 
2 P 


To  determine  K for  the  function  we  must  again  revert  back  to  the 

worst  case  initial  conditions  and  maximum  allowable  time  (this  was  chosen 
in  the  range  control  law  to  be  3 minutes).  Worst  case  initial  conditions 
from  the  stationkeeping  phase  are  shown  in  Figure  16.  The  position  error 
is  seen  to  be  about  -11  feet  whereas  velocity  error  is  about  -1.2  ft/sec 
(due  to  minimum  impulse  rates  from  translational  and  rotational  control) . 
Using  this  I.C.,  K is  found  to  be  0.0575  and  k/(K  + 4)  equals  0.0142.  These 
small  values  may  be  increased  slightly  because  of  the  high  sensitivity  of 
the  f2(Zp)  faction  to  a rate  error  in  Zp.  The  desired  deadband  as  shown 
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Phase  Plane 


9.10.2  Automatic  Docking  Control  Law  (contM) 


Figure  16 

Worst  Case  Position  I.C. 
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9.10.2  Automatic  Docking  Control  Law  (con't) 


in  Figure  15  is  one  foot.  To  account  for  u thruster  firings  the  phase 

Li 

plane  is  broken  into  several  control  regions,  as  illustrated  in  Figure  17. 
With  no  Z-thruster  control  disturbances,  u^ , the  firing  times  for  Regions 
I,  II,  and  III  are  calculated  in- the  same  manner  as  the  other  phase  planes. 
Namely, 


Region 

I 

125  = X - .125 

a 

(8) 

Region 

II 

X0  . . 1,  K s X' 
a y K + 2^  a 

(9) 

Region 

III  = 

— = X 

a 0 

(10) 

However,  in  Regions  I,  II,  and  III,  if  a non-zero  command  is  scheduled 

« 

from  the  (Z  , Z ) phase  plane,  and  this  would  cause  the  (Z  , Z ) state 
eg  eg  P P 

to  diverge  (because  of  disagreement  in  sign) , then  this  command  is 
treated  as  a disturbance  and  the  (Z^,  Z^)  firing  time  is  increased  pro- 
portionately for  opposing  commands 


"Region  I,  II 


= t +i  t * 

Region  I,  II  5 (Z,  Z) 


(ID 


However,  as  the  net  acceleration  during  this  disturbance  period  is  re- 
duced by  20  percent, convergence  time  in  the  phase  plane  may  be  increased. 
If  this  proves  a significant  factor, K will  be  increased.  Commands  in 
the  proper  direction  are  not  compensated  for  as  this  would  cause  chatter- 
ing during  long  Z firing  times.  In  Region  III  a u command  in  either 

Li 

direction  should  be  compensated  for 

tRegion  III  = Region  III  1 5 fc(Z,Z)  (12) 

as  the  desired  control  action  is  to  drive  the  rate  to  zero. 

Finally,  in  Region  IV,  no  control  action  is  taken  unless  there 
Is  a U£  command;  then  the  desired  control  action  is  to  drive  the  rate  to 
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9.10.2  Automatic  Docking  Control  Law  (con't) 


zero  through  differential  jet  firings.  The  firing  time  equation  is 

Zp  + UZ  t(Z,Z)  " £ue  t(Z  , Z ) = 0 

P P 

Hence,  the  sign  of  the  control  is  given  by 


sign  (tue)  - sign  <Zp  + uzT(z>  z)) 


(13) 


The  firing  time  by 


Region  IV 


Zp  + uz  t(Z,  Z) 

*ue 


(14) 


A dual  relation  exists  for  control  in  the  X-Y  plane  (see 
Figure  18).  The  position  errors  are 


Ycg  = ~R  Sin  (fR  + " ^sin\ 


Y = -R  sin  (y  + g) 
P R 


Applicable  control  accelerations  are 


"Y  + 


eg 


“Y 


R 


"t 


The  desired  end  condition  requires 


(1)  Y + JW_  = 0 

eg  R 


(2)  Y , Y = 0 

P P 
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Illustration  of  Y 


9.10.2  Automatic  Docking  Control  Law  (con't) 


The  switching  logic  is  identical  except  for  Region  IV  where  the 
sign  of  the  control  effort  is  given  by 

Sign  (£uf)  = -sign  (Y  + t^  (15) 

and  the  firing  time  is  given  by 

CRegion  IV 

5. 8 Relative  Roll  Control 

Relative  roll  control  will  be  the  same  as  that  used  in  Phase  1 
except  that  the  deadband  will  be  reduced  to  comply  with  docking  con- 
straints and  close-in  measurement  accuracies.  Two  degrees  will  be 
assumed  initially. 

6.  Detailed  Flow  Diagrams 

This  section  contains  the  flow  diagrams  for  the  Automatic 
Docking  Control  Law. 


Yp  + UY  t(Y,  Y) 

-£u,„ 


(16) 
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9.10.2  Automatic  Docking  Control  Law  (con't) 


T*fc  T d LL  <6  W iKt  C-i  VucAw 
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9.10.2  Automatic  Docking  Control  Law  (con't) 
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9.10,2  Automatic  Docking  Control  Law  (con't) 


9.10-75 


9.10.2  Automatic  Docking  Control  Law  (con't) 
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9.10.2  Automatic  Docking  Control  Law  (con't) 


k LATE  ML 
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9.10.2  Automatic  Docking  Control  Law  (con't) 
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9.10. 2 


Automatic  Docking  Control  Law  (con't) 
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9.10.  2 Automatic  Docking  Control  Law  (con't) 
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9.10.2  Automatic  Docking  Control  Law  (con't) 
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9.10.2  Automatic  Docking  Control  Law  (con't) 
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9.10.2  Automatic  Docking  Control  Law  (cont  d) 
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9.10.2  Automatic  Docking  Control  Law  (cont'd) 
Reference 


EG  2-70-149,  "Docking  Sensor  Error  Model,"  dated  16  September 
1970. 
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DOCKED  OPERATIONS 


The  GN&C  functions  during  docked  operations  are  undefined. 
Some  of  the  candidate  functions  are  the  following: 

1.  Targeting  for  Rendezvous,  Deorbit,  Orbit 
modification. 

2.  Absolute  and  Relative  Navigation. 

3.  Provide  Guided  AV's  to  the  Space  Station. 

4.  Attitude  Control  of  the  docked  cluster. 

5.  Sensor  Calibration  and  Alignment. 

6.  System  Monitor,  Test  and  Checkout. 
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